


一 wm 
"A 4 | ] 局 
ee 
| pm | 4 
一 天 一 CC 一 0 i wd rt 


(机械 /机 电 / 控 制 类 ) 


罗 庆 生 韩 笃 玲 中等 编 普 























人 LR 人 和 
| 


rR 





Dey “ne 








Ee 









i 
a pe 
中风 


i 


可 二 


人 


ea 


pr 


DUUUUUUUUU 
UUUUU 


《机械 \ 机 电 \ 控 制 类 ) 


罗 庆 生 ” 韩 宝 玲 等 编著 
主要 写作 人 员 : 罗 庆 生 韩 宝 玲 罗 雪 李 华 师 


权 红 亮 项 伟 张 竣 
参加 写作 人 员 ; 杨 成 伟 还 鹏 向 前 友 李 嘉 玉 
赵 小 川 苏 晓 东 奢 汉 越 ” 刘 禄 续 


黄 党 顺 岂 向 程 勇 吴 帆 
赵 欣 驰 冯 达 


瑶 天 颈 王 勇 智 耕 王 帅 


@ 


机 械 工 业 出 版 社 


草 日 


何 源 


张 叶 青 


交 ” 李 人 金 科 


J 
光 吴 


杨 继 伟 
牛 氏 
周 双 
莫 洋 











本 书 对 作者 的 团队 参加 大 学 生 识 外 科 拉 创新 苋 客 的 获奖 作品 进行 了 详尽 的 介绍 和 剖析 ， 
所 述 作品 的 研究 背景 、 设 计 理 论 、 基 本 构成 、 机 构 特 点 、 运 动 特性 、 关 键 技术 、 创 新 成 果 、 
发 展 前 景 均 是 作者 根据 实际 工作 总 结 而 成 ， 展 示 了 他 们 参与 大 学 生 读 外 科技 创新 活动 的 水 平 
和 成 果 ， 也 代表 着 作 者 对 大 学 生 课 外 科技 创新 活动 的 认识 与 把 握 。 

本 书 共 11 音 ， 系 统 前 述 了 “新 型 多 用 途 反 恐 防 骏 机 器 人 ” “新 型 特种 搜救 机 右 人 ”“ 新 
型 轮 腿 式 机 器 人 ”“ 新 型 节 胶 机 器 人 ” “新 型 仿生 六 足 机 器 人 ”人 “ 新 型 工业 焊接 机 械 臂 天 
“边缘 救援 平台 ”“ 千 足 虫 宠物 机 器 人 ”““ 外 骨骼 ”智能 健 且 与 康复 机 器 人 ”“ 高 处 空间 
物品 存放 及 管理 系统 ”和 “壁面 清洲 智能 机 需 人 ”的 研究 育 景 及 意义 、 作 品 概述 、 关 键 扩 术 、 
主要 创新 点 及 取得 成 采 、 总 结 与 展望 。 

本 书 在 介绍 和 论述 过 程 中 独力 突出 大 学 生 课 外 科技 创新 活动 的 新 理念 、 新 技术 、 新 方法 
和 新 成 有 末 ， 以 期 对 从 事 读 外 科技 创新 活动 的 指导 老师 和 大 学 生 提 供 助 蔓 和 局 发 。 
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话 心 聚 力 ， 帮 助 大 学 生 科 技 创 新 起 跑 和 腾飞 ( 代 友 ) 


北京 理工 大 学 机 电学 院 特 种 机 器 人 技术 研究 中 心 成 并 于 2005 年 ， 由 博士 生 导 师 罗 庆生 教 
授 和 博士 生 导 师 韩 宝 玲 教 授 带 领 ， 是 一 文 拥 有 博士 生 导 师 、 教 授 、 高 工 、 博 士 等 高 水 平 人 才 
的 研究 团队 ， 成 员 三 十 余人 。 该 中 心 多 年 来 一 直 进 行军 用 机 器 人 、 工 业 机器人、 机电 伺服 控 
制 技术 、 机 电 设 备 测试 技术 、 机 电 系 统 传 感 技术 和 机 电 产 品 创新 设计 等 的 研发 工作 ， 在 科学 
研究 、 技 术 创 新 、 产 品 开发 、 成 果 转 化 、 人 才 塔 养 等 方面 时 有 建树 ， 在 国内 孚 有 很 高 的 知名 
度 和 影响 力 。 近 年 来 ， 该 中 心 整 合 了 全 校 多 个 相关 学 科 的 技术 、 人 才 和 信息 优势 ， 成 为 一 文 
攻关 力量 强大 、 研 发 经 验 丰 富 、 满 足 市 场 需求 的 高 新 科技 研发 实体 ， 并 与 一 些 企业 建立 起 民 
好 的 产 学 研 协作 关系 ， 推 动 看 机 电 何 服 控 制 技术 与 特种 机 器 人 技术 及 产品 的 不 断 进 步 。 在 承 
担 国家 “863”、“973” 和 一 些 省 部 级 纵 回 诬 题 研究 过 程 中 ， 中 心 成 员 更 是 大 大 提升 了 目 身 
的 理论 水 平和 技术 能 力 ， 指 导 大 学 生 开 展 课外 科技 创新 活动 的 能 力 与 水 平 也 在 与 时 俱 进 。 

罗 庆 生 教 授 是 北京 理工 大 学 机 械 电 子 工程 本 科 专 业 员 任教 授 ， 他 深 知 创 狐 素养 的 寺 育 、 
创新 潜力 的 开发 、 创 新 品格 的 激励 、 创 新 能 力 的 训练 对 新 时 期 大 学 生 创 新 型 人 才 培 养 的 重要 
性 。 埋 宝 玲 教授 曾 担任 北京 理工 大 学 教务 处 主管 本 科教 学 工作 副 处 长 ， 她 也 深 感 培养 具有 “高 
远 的 理想 ， 精 深 的 学 术 ， 强 健 的 体 鲍 ， 恒 美的 心境 ”的 新 时 期 大 学 生 复 合 型 人 才 在 我 国 高 等 
教育 中 的 紧迫 性 。 为 使 培养 出 来 的 学 生成 为 创新 型 、 复 合 型、 通才 型 的 人 才 ， 在 多 年 的 科研 、 
教学 实践 中 ， 罗 庆生 教授 、 需 宝 玲 教授 市 领 团 队 探索 并 实施 了 “书本 内 外 结合 、 诛 符 内 外 络 
合 、 校 园 内 外 结合 、 理 论 实际 结合 、 继 承 创新 结合 、 动 脑 动手 结合 ”的 新 型 教学 模式 ， 并 把 
这 一 模式 贯彻 到 指导 大 学 生 开展 课 外 科技 创新 活动 中 去 。 

特种 机 器 人 技术 研究 中 心 在 罗 庆 生 教 授 、 围 宝 玲 教授 带领 下 ， 通 过 反复 实践 、 积 极 探 索 
和 认真 总 结 ， 形 成 了 以 指导 大 学 生 开展 诬 外 科技 创新 活动 为 主体 ， 辅 以 短期 性 、 专 业 性 座 程 
教学 的 新 型 创新 教育 模式 。 

在 新 型 创新 教学 法 、 创 新 指导 法 实施 过 程 中 ， 研 究 中 心 紧 密 结合 现 有 实验 设备 、 重 点 研 
究 方 向 、 关 键 技术 领域 及 教师 在 研 课题 ， 以 多 领域 的 科研 课题 和 多 学 科 的 科研 经 验 为 实施 理 
论 教学 、 实 验 教学 、 实 践 教学 提供 重要 依托 和 直接 帮助 。 

实施 过 程 中 ， 该 中 心 始终 坚持 “大 学 生 诛 外 科技 创新 活动 、 毕 业 议 计 评 题 、 实 验 室 项 目 ” 
三 位 一 体 的 结合 方式 ， 并 提出 “以 高 带 低 、 以 硕 带 本 ”的 创新 实践 理论 。 团 队 成 员 积 极 指导 
不 同 专业 、 不 同年 级 的 大 学 生 开 展 课 外 科技 创新 活动 ， 充 分 发 挥 特 种 机 器 人 研发 中 心 在 机 需 
人 核心 技术 方面 多 年 来 形成 的 优势 ， 以 研究 中 心 的 实验 设备 和 工作 室 为 便 件 ， 以 团队 成 员 研 
完 经 验 、 实 验 技能 等 为 软件 ， 软 人 硬结 合 ， 为 大 学 生 创 新 能 力 的 塔 弈 提供 全 方位 文 持 ， 针 对 大 
学 生 课 外 科技 创 狐 活动 的 其 体内 容 ， 开 展 了 综合 性 、 设 计 性 、 创 狐 性 的 设计 类 实验 与 设计 类 
实践 活动 ， 锻 炼 和 提升 学 生理 论 与 实践 相 结 合 、 动 脑 与 动手 相 结合 的 能 

在 指导 大 学 生 开展 读 外 科技 创新 活动 中 ， 特 种 机 器 人 技术 研究 中 心 广 泛 采 用 学 习 小 组 互 
动 、 活 动 小 组 互动 、 设 计 专 题 互 动 等 形式 ， 发 挥 互 动 行 为 在 塔 养 学 生 辨 析 思 维 能 力 、 强 化 学 
生 质 疑问 题 能 力 、 发 展 学 生 人 际 交 流 能 力 、 锻 炼 学 生 构 思 方 案 能 力 等 方面 的 强大 作用 。 与 此 
同时 ， 特 种 机 器 人 技术 研究 中 心 还 灵活 运用 反馈 策略 ， 使 师 生 双方 依据 反馈 信息 ， 及 时 调整 



































































































































大 学 生 课 外 科技 创新 竞赛 获奖 作品 精 析 


教 与 学 的 天 系 ， 提 高 教 与 学 的 效率 ， 将 在 教学 中 、 实 验 中 、 实 践 中 获取 知识 的 主动 权 交 给 学 
生 ， 增 强 学 生 开展 综合 性 、 设 计 性 、 创 新 性 实践 活动 的 信心 和 能 
特种 机 各 人 技术 研究 中 心 的 全 体 成 员 通 过 多 年 的 积极 探索 和 认真 总 结 ， 构 建 了 “问题 一 
探索 一 解 谷 一 结论 一 狐 问 题 一 新 探索 一 独 解 答 一 独 结论 ”的 新 型 反馈 式 、 开 放 式 、 创 新 式 、 
实践 式 教 学 模式 ， 促 使 学 生 在 开展 读 外 科技 创新 过 程 中 “多 看 、 多 想 、 多 问 、 多 议 、 多 试 ” 
使 学 生 从 单纯 学 习 者 转变 成 参与 者 、 实 施 者 和 促进 者 ， 激 发 了 参 研 学 生 们 学 习 的 目 沉 性 、 主 
动 性 和 创新 热情 ; 提高 了 学 生动 脑 思考 动手 实践 的 能 力 、 分 析 问 题解 决 问题 的 能 力 、 创 新 设 
计 创 新 实现 的 能 力 ， 提 升 了 学 生 团队 协作 ， 集 体 攻关 的 能 力 ; 培养 了 学 生 的 科研 热情 和 科研 
意识 ， 为 学 生成 为 科研 团队 的 后 备 力量 和 投身 于 今后 的 科研 工作 务实 基础 。 据 统计 ， 参 加 特 
种 机 器 人 技术 研究 中 心 组 织 、 指 导 、 菩 训 的 读 外 科技 创新 项 目的 学 生 中 ，80% 一 90% 的 学 生 获 
得 了 免试 推荐 研究 生 的 资格 并 选择 在 本 校 深 造 ， 部 分 学 生 以 优异 的 成 绩 考 取 了 清华 大 学 、 北 
各 航空 航天 大 学 等 院 校 的 研究 生 ; 选择 留学 的 学 生 更 是 凭借 痢 参 加 创新 项 目的 丝 历 、 与 创新 
团队 一 起 披 刑 术 束 、 盏 勇 攻 关 所 历练 出 的 能 力 ， 得 到 了 国外 闭 名 大 学 的 认可 和 和 采取。 
众所周知 ， 当 前 在 我 国 高 等 院 校 范 围 内 影 啊 最 大 、 范 围 最 广 、 水 平 最 高 的 大 学 生 读 外 科 
拉 创 新 成 来 苋 弗 包括 “挑战 标 全 国 大 学 生 课外 学术 科 拉 作品 苑 完 “全 国 大 学 生 创新 性 实验 
计划 项 目 苋 完 ”、“ 全 国 大 学 生机 械 创 新 设计 大 赛 ”"。 在 这 三 大 完事 中 ， 罗 庆生 教授 、 贺 宝 玲 教 
授 近 五 年 来 指导 的 获奖 项 目 束 有 十 余 项 ， 其 中 更 有 一 些 是 名 列 前 订 、 独 占 人 鳌头 。 
> 2007 年 6 月 -2008 年 10 月 ， 罗 庆生 教授 、 辆 玲玲 教授 指导 了 “教育 部 大 学 生 创新 性 
实验 计划 项 目 ” 一 一 痢 型 多 用 途 反 灵 ， 防 暴 机 器 人 的 研制 工作 。 该 项 目 在 2008 年 10 月 
于 长 沙 举行 的 肯 届 全 国 大 学 生 创 新 论坛 中 荣获 “我 最 到 爱 的 10 件 作 品 ” 称 号 ， 且 排 
名 第 一 。2009 年 5 月 ,“ 新 型 多 用 途 反 芽 防 又 机 器 人 ”在 参加 北 页 举办 的 “全 国 科技 
周 开 有 需 式 ” 展 出 时 ， 受 到 国务 委员 刘延东 、 科 学 技术 部 部 长 万 钢 等 领导 同志 的 高 度 评 
价 ， 在 国内 引起 极 大 反 啊 。 
> 2008 年 5 月 -2009 年 10 月 ， 碍 宇 玲 教授 、 风 庆生 教授 指导 了 “教育 部 大 学 生 创新 性 
实验 计划 项 目 ” 一 一 新 型 特种 搜救 机 如 人 的 研制 工作 。 该 项 目 在 2009 年 10 月 于 南京 
举办 的 第 二 届 全 国 大 学 生 创新 论坛 中 来 获 “ 我 最 喜爱 的 10 件 作品 ”称号 。 
> 2009 年 5 月 -2010 年 9 月 ， 多 庆生 教授 指导 了 “教育 部 大 学 生 创新 性 实验 计划 项 
目 ” 一 一 新 型 轮 腿 式 机 器 人 的 研制 工作 。2010 年 9 月 ， 在 大 连 举办 的 第 三 届 全 国 大 
学 生 创新 论坛 上 ， 两 个 作品 均 获 得 “我 最 豆 爱 的 10 件 作 品 ” 称 写 ， 其 中 “新 型 纶 腿 
式 机 各 人 ”项 目 在 “我 最 吾 爱 的 10 件 作 品 ” 排 名 第 五 。 
> 2009 年 11 月 ， 岁 庆生 教授 指导 的 “新 型 多 用 途 反 榴 防 暴 机 副 人 ”项 目 参 加 了 第 十 一 
届 “ 挑 战 杯 全 国 大 学 生 读 外 学 术 、 科 技 作 品 营 赛 ”， 获 得 一 等 奖 。 
> 2010 年 5 月 ， 因 至 玲 教授 、 罗 庆生 教授 指导 的 “新 型 特种 搜救 机 器 人 ”项 目 参 加 了 
在 北京 举办 的 “全 国 科 技 成 末 展 示 会 ” 展 出 ， 受 到 国务 委员 刘延东 、 科 学 扩 术 部 部 长 
万 钢 等 领导 同 忘 的 高 度 评 价 ， 国 内 主要 巡 体 都 作 了 重点 报道 。 
> 2010 年 10 月 ， 罗 庆生 教授 与 办 伟 老 师 率领 四 件 作 品 参 加 在 江苏 南 泵 举办 的 第 四 届 全 
国 大 学 生机 械 创新 设计 大 先决 赛 ， 四 件 作品 均 获得 一 等 奖 ， 总 成 绩 名 列 全 国 第 一 ; 其 
中 罗 庆 生 教授 指导 的 “边缘 救援 平台 ”项 目 得 到 与 会 专家 和 现场 观众 的 一 致 好 评 。 
> 2011 年 10 月 ， 罗 庆生 教授 为 指导 教师 、 机 电学 院 三 年 级 本 科 生 为 主要 成 员 、 融 合 了 
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数 名 其 他 专业 本 科 生 的 “智能 机 各 人 代表 队 ” 代 表 北 京 理工 大 学 参加 了 于 蛤 尔 泥 举行 
的 首届 “中 俄 工科 大 学 联盟 ”大 竺 生机 副 人 创 独 大 完 及 展示 。“ 中 俄 工科 大 学 联盟 ” 
由 30 所 中 国 和 俄罗斯 两 国 项 尖 的 工科 院 校 组 成 ， 代 表 看 中 俄 两 国 在 工科 领域 的 科技 
实力 和 办 学 水 平 。 北 京 理 工大 学 “智能 机 器 人 代表 队 ” 创 造 了 在 所 参加 项 目 中 均 获 得 
炎 项 的 好 成 绩 。 多 庆生 教授 指导 的 全 国 大 学 生 创新 性 实验 项 目 一 一 新 型 节 胶 机 需 人 在 
大 会 展示 活动 中 获得 “最 佳 团 队 交 ”“ 知 能 机 霹 人 代表 队 ” 还 获得 “最 佳 组织 奖 ” 
代表 队 总 获奖 数 达 到 六 项 ， 为 此 次 赛事 捷 颁奖 项 的 四 分 之 一 ,是 所 有 参赛 学 校 中 获得 
奖项 最 多 的 。 
> 2011 年 10 月 ， 罗 庆生 教授 率领 北京 理工 大 学 代表 队 参 加 在 同济 大 学 举办 的 “第 四 届 
全 国 大 学 生 创新 年 会 ”， 两 个 作品 均 获 得 论坛 “我 最 喜爱 的 10 件 作 品 ” 称 写 ， 罗 庆生 
救 授 、 贺 宝 玲 教授 指导 的 “新 型 市 股 机 如 人 ”项 目 以 绝对 领先 的 得 容 数 排名 第 一 。 
> 2012 年 5 月 ， 罗 庆生 教授 、 融 宝 玲 教授 指导 的 “和 干 足 虫 宠物 机 带 人 ”“ 宇 内 局 处 空 
间 物 品 存放 及 管理 系统 ~“ 外 骨骼 智能 健 吴 与 康复 机 器 人 ”和 “壁面 清 清 智 能 机 闫 人 ” 
等 四 项 作品 参加 了 “首都 高 校 第 六 届 机 械 创 靳 设计 大 赛 ”。 上述 四 项 作品 全 部 获得 一 
等 奖 ， 并 将 代表 北 束 市 参加 在 西安 举行 的 “全 国 第 五 届 大 学 生机 械 创 新 设计 大 赛 ” 总 
决赛 。 
> 2012 年 10 月 ， 这 党 全 国 的 “ 痢 型 节 胶 机 器 人 ”， 以 其 丰 军 的 行进 步 态 、 精 彩 的 运动 
效 琳 、 可 徘 的 控制 性 能 、 超 群 的 演示 功能 ， 代 表 教 育 部 系统 出 席 中 共 中 央 宣 传 部 、 
家 发 展 与 改革 委员 会 举办 的 “科学 发 展 ， 成 就 辉 焊 ” 全 国 科 技 成 有 末 展 ， 以 迎接 笛 的 十 
闪 厂 胜利 但 于 
海 阔 插 鱼 路 ， 天 局 任 鸟 飞 。 当 前 ， 我 们 的 国家 正和 面临 科学 发 展 、 开 拓 创 新 的 大 好 时 机 ， 
时 不 我 等， 创新 年 代 需 要 创新 人 才 ， 创 新 人 才 需 要 创新 培养 。 北 京 理 工大 学 特种 机 器 人 技术 
研究 中 心 在 教学 育 人 、 科 研 育 人 、 创 新 育 人 等 方面 做 出 了 一 坚 符 试 ， 取 得 了 一 些 成 末 ， 愿 这 
坚 答 试 与 成 东 能 够 成 为 我 国 广大 学生 们 不 断 创 新 、 不 断 开 拓 的 铺路 石 ， 让 我 们 共同 贫 融 通 往 
创新 成 才 的 康 庄 大 道 。 








































































































中 国 工 程 院 院士 汞 英 质 
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广泛 、 深 入 、 成 功 地 开展 大 学 生 读 外 科技 创新 活动 是 我 国 高 等 教育 创新 型 人 才 培 养 目标 
的 重要 体现 ， 其 作用 和 总 义 十 分 重大 。 当 前 ， 我 国 各 局 等 院 校 及 各 专业 学 科 痢 十 分 重视 大 学 
生 读 外 科技 创新 活动 的 开展 与 实施 ， 都 把 这 种 活动 看 成 是 促进 大 学 生 创 新 型 人 才 培 养 的 加 速 
各 和 孵化 右 。 作 者 及 其 学 术 团 队 坚 持 大 学 生 读 外 科技 创新 指导 工作 已 有 多 年 ， 在 指导 大 学 生 
诛 外 科 拉 创 狐 活动 方面 成 来 丰 明 、 水 平 突出 ， 所 指导 的 大 学 生 诛 外 科技 创新 项 目 获 得 过 多 项 
国家 级 奖项 ， 罗 庆生 教授 、 础 宝 玲 教授 也 古国 内 最 得 名 的 大 学 生 谍 外 科技 创新 活动 指导 专家 。 

一 个 国家 、 一 个 民族 、 一 个 社会 、 一 个 团队 ， 其 发 展 前 景 与 创新 密切 相关 ， 而 创新 需要 
创新 型 人 才 ; 创新 型 人 才 除 了 需要 创新 意识 、 创 新 精神 、 创 新 激励 以 外 ， 还 需要 创新 思考 、 
创新 实践 和 创新 训练 。 为 了 提升 我 国 大 学 生 在 开展 读 外 科技 创新 活动 时 的 创新 思考 水 平 、 创 
新 实践 能 力 和 创新 训练 难度 ， 使 更 多 的 大 学 生 在 开展 读 外 科技 创新 活动 时 有 经 验 可 以 借鉴 、 
有 方法 可 以 参考 、 有 技术 可 以 复制 、 有 成 末 可 以 移植 ， 我 们 精 选 了 近年 来 由 团队 主要 成 员 指 
导 的 在 “挑战 杯 全 国 大 学 生 读 外 学 术科 技 作 品 竞 赛 人 “全国 大 学 生 创新 性 实验 计划 项 目 驶 
赛 ” 人 “全 国 大 学 生机 械 创 新 设计 大 赛 ” 中 大 放 肛 彩 、 引 领 湖 流 的 11 项 获奖 作品 ， 将 其 研究 痛 
景 、 立 项 依据 、 主 体 思 路 、 关 键 技 术 、 创 新 成 末 编 手 成 蔬 ， 以 给 读者 。 

本 书 介绍 的 这 些 作 品 因 完 善 的 功能 配备 、 独 特 的 方案 设计 、 巧 妙 的 结构 安排 、 合 理 的 决 
束 规 划 、 优 和 卉 的 运动 特性 、 稳 定 的 性 能 表现 、 癌 效 的 控制 机 理 、 狐 宁 的 感 测 技 术 、 人 完备 的 能 
源 管理 、 科 学 的 实验 方法 、 有 益 的 经 验 体 会 、 广 阔 的 应 用 前 景 而 引人入胜 。 本 书 以 这 些 作 品 
的 研发 思路 为 主线 ， 核 心 技术 为 依托 ， 创 新 成 末 为 抓 手 ， 总 结 团 队 在 指导 大 学 生计 外科 拉 创 
新 活动 中 设计 的 新 理念 、 探 索 的 新 思路 、 研 发 的 新 技术 、 实 验 的 痢 方 法 、 工 作 的 新 成 末 ， 系 
统 地 介绍 给 读者 ， 以 推动 大 学 生 读 外 科技 创新 活动 在 我 国 各 高 等 院 校 更 加 普及 、 更 加 深入 的 
开展 。 

本 书 所 述 作品 的 研究 背景 、 设 计 理 论 、 基 本 构成 、 机 构 特 点 、 运 动 特性 、 关 键 扩 术 、 创 
新 成 果 是 作者 根据 实践 工作 总 结 而 成 ， 展 示 了 大 学 生 读 外 科技 创新 活动 的 水 平和 成 末 ， 也 代 
表 看 作者 对 大 学 生 诛 外 科技 创新 活动 的 认识 与 把 握 。 本 书 在 介绍 和 论述 过 程 中 看 力 突出 大 学 
生 读 外 科技 创新 活动 的 新 理念 、 新 技术 、 痢 方法 和 新 成 有 末 ， 以 期 对 从 事 读 外 科技 创新 活动 的 
大 学 生 们 能 够 有 所 助 蔓 和 局 发 。 

本 书 共 十 一 革 , 系统 曾 述 了 “新 型 多 用 途 反 灵 ， 防 暴 机 锋 人 天 “新 型 特种 搜救 机 严 人 入 “者 
型 轮 腿 式 机 器 人 和 “新 型 万 胶 机 天 人 天 “ 独 型 仿生 六 足 机 器 人 ”人 “新 型 工业 焊接 机 械 避 和 
“边缘 救援 平台 天 “千足 虫 老 物 机 器 人 ” “外 骨骼 ”智能 健身 与 康复 机 器 人 入 “高 处 空间 物 
品 存 放 及 管理 系统 ”和 “壁面 清洁 智 能 机 融 人 ”的 研究 背景 及 意义 、 作 品 概述 、 关 键 撤 术 、 
主要 创新 点 及 取得 成 末 、 总 结 与 展望 。 本 书 由 多 庆生 、 震 至 玲 负 责编 善 ， 多 下、 李 华师 、 鸡 
持 、 攀 红 迪 、 曾 伟 、 张 辉 、 参 与 了 大 量 的 写作 工作 ， 杨 成 伟 、 偿 鹏 、 疝 前 友 、 李 吝 玉 、 何 濒 、 
杨 继 伟 、 赵 小 川 、 苏 晓 东 、 获 汉 越 、 间 社 纬 、 梁 冠 昌 、 牛 能 、 黄 荣 、 匡 纪 、 向 程 勇 、 半 帆 、 
张 叶 青 、 周 双 、 赵 欣 驰 、 冯 达 、 罗 翔 辉 、 曹 虹 蛟 、 李 金 科 、 莫 洋 、 魏 天 异 、 王 勇 、 智 耕 、 王 
是 、 范 吴 参 与 了 部 分 草 市 的 撰 与 和 相关 资料 的 整理 工作 。 
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当前 ， 我 国 大 学 生 诛 外 科技 创 新 活动 的 热 泣 风 起 云 涌 ， 作 者 所 开展 的 工作 及 其 成 来 只 是 
沧海 一 村 。 要 使 我 国 大 学 生 读 外 科技 创新 活动 的 水 平 能 够 真正 满足 创新 型 人 才 蔽 养 的 需要 ， 
还 需 集 众人 之 吞 、 众 人 之 力 才能 有 所 作为 ,希望 本 书 的 出 版 发 行 能 起 到 抛砖引玉 的 作用 ， 同 
时 也 和 希望 三 大 专家 、 该 者 对 本 书 的 读 误 乙 处 不 音 赐教 。 

最 后 ， 问 文 持 我 国 大 学 生 读 外 科技 创新 活动 的 各 级 领导 、 专 家 和 同事 们 表示 衷心 的 感谢 ， 
问 本 书 所 引用 参考 文献 的 作者 和 文 持 本 书 出 版 发 行 的 机 械 工业 出 版 社 表示 诚 测 的 第 昔 。 
































作 者 


目录 


凝 心 聚 力 ， 帮 助 大 学 生 科技 创新 起 跑 和 腾飞 〈 代 序 ) 




















前 言 

第 1 章 新 型 多 用 途 反 丽 防暴 机 器 人 ] 
(第 一 届 全 国 大 学 生 创 新 年 会 “我 最 喜爱 的 10 个 项 目 ” 排名 第 一 ，2008 年 ) .ee 1 
Te ee a ee ed ed 1 
2 OE IO TO WA el WO No We 2 
A ee 有 
0 4 
人 4 
村 二 国有 4 
R22 I 9 
LS a 14 
1.3 直 :控制 与 无线 通信 技术 19 
了 30 
本 33 
光 罗 且 本 人 33 
有 33 
和 33 
Es 1) eR 33 
1.5.2 ”作品 应 用 范围 及 前 景 分 析 35 
2 a OO OE TO 35 

2 36 
《第 二 届 全 国 大 学 生 创新 年 会 “我 最 喜爱 的 10 个 项 目 ” 排名 第 三 ，2009 年 ) .ee 36 
2.1 作品 研究 的 背景 及 意义. 36 
OOP 38 
DO 38 
00 40 
Dt 40 
清关 全 下 生生 全 生生 全 下 全球 40 
2 43 
2 48 
本 52 
全 相让 全 全 本 全 全 下 生生 60 
| 62 
Dad 62 
242 作品 取得 的 成 果 0 63 
DO 63 


D0 63 



































2 64 
2 64 
SE 0 66 
(第 三 届 全 国 大 学 生 创 新 年 会 “我 最 襄 爱 的 10 个 项 目 ” 排名 第 五 ; 2010 年 append 66 
3 MI a ee 66 
00 68 
国人 68 
30005 69 
Ge 70 
3 70 
0 74 
Be SD de 78 
93.34 7 机 3 人们 瑟 司 人 a 87 
3 91 
BA ee 91 
0 CD OEE EC 92 
下 92 
于 全 93 
Sd. HU a a 94 
(第 四 届 全 国 大 学 生 创 新 年 会 “我 最 喜爱 的 10 个 项 目 ” 排名 第 一 ，2011 年 ) .ee 94 
i ME dd 94 
有 95 
人 95 
OTE OSORIO EO TS OCU eNO VOOR YEON OOO ORONO DOD IOUT OOP ER 98 
4.3 “关键 技术 98 
人 98 
432 控制 系统 与 多 御 运 动 欣 制 技术 有 的 和 全 ea 102 
1433 水 在 作 制 理 放 写 投 术 AR 108 
人 110 
ee 0 ETO OE OO ET 112 
G6 EE Se 113 
Wg 7 0 2 OO 114 
省 116 
本 116 
0 117 
3 117 
OOOO OOO SOOO DOA OP OO PO ON 122 
和 5 型 仿生 7 是 机 证 人 od 123 
(第 五 届 挑 战 杯 首都 大 学 生 课外 学 术科 技 作品 竞赛 一 等 奖 ，2009 年 )》 .es 123 
0 OC 123 
2 124 
2 124 


大 学 生 课 外 科技 创新 竞赛 获奖 作品 精 析 























2 7 es CO OO OOO PO OCT EPI OOO OPN 125 
S03 125 
SS a 125 
SO MW 133 
S73 he A 137 
St 144 
SR 交 生生 生生 生生 入 生生 生生 全 全 和 作 生生 和 生生 全 151 
5 164 
人 170 
5 全 和 人 | 170 
3 171 
人 171 
Sol SE 171 
.5 Ee a a 172 
RTE OP DIO OOOO ROO IRIE RDO NES 172 
SO aT 174 
CT 从 届 下 世 针 村 ” 引 这 理 上 上 太 学 呈 外 他 术科 拉 作 员 训 放生 01l nn 174 
Ge NT I CR ee ed 174 
02. 174 
G32 I EE 174 
人 176 
人 176 
GE 176 
32 NT I | ee 180 
G0 eee on he ld 187 
Ge ee 207 
WO 216 
6: SO dae 225 
OO ee 225 
Gd ME ee en ed 226 
GG 226 
OS ol i eM 226 
6 229 
te 227 
第 7 章 ”边缘 救援 平台 .nn 229 
(第 四 届 全 国 大 学 生机 械 创新 设计 大 赛 一 等 奖 ，2010 年 ) 229 
ET 229 
To 230 
TO I 230 
Re 231 
TC dn 232 
二 232 



































TD 233 
TR 238 
A 0 = SO 241 
Td ON ee 245 
本 245 
于 245 
JW 246 
下 全 人 246 
第 昌 章 于 是 利 宛 物 机 商 尖 全 和 248 
(首都 高 校 第 六 届 机 械 创 新 设计 大 赛 一 等 奖 ，2012 年 ) .cb. 248 
上 248 
和 248 
OD A ee 248 
人 249 
3 249 
8 ce Ca 249 
QO NT 259 
| 263 
| 273 
So 0 SD OO OO EO 276 
区 276 
本 全 全 277 
ER 77 
人 277 
8.5.2 ”作品 应 用 范围 及 前 景 分 析 .rr 278 
a 278 
第 9 章 “外 骨骼 ”智能 健身 与 康复 机 器 人 280 
(第 五 届 全 国 大 学 生机 械 创 新 设计 大 赛 二 等 奖 ，2011 年 ) 280 
9 NT a 280 
0 283 
9 283 
人 285 
O03 285 
931，. 人 体 解 下 学 与 股 休 冯 动机 强人 外 析 技术 aedeneee ee 285 
Ot 289 
93 nl 301 
C0 306 
Qa ee 308 
Ga: 308 
9.4.2 ”作品 取得 的 成 果 .0 309 
7 OTE OE TT WI TO ET RO A I RO 309 
O00 309 












































人 310 
人 311 
第 10 章 ， 高 处 空间 物品 存放 及 管理 系统 313 
(首都 高 校 第 六 届 机 械 创 新 设计 大 赛 二 等 奖 ，2012 年 ) 313 
POM: ME Sa ee 313 
Oc 315 
O05 315 
O22 Ee 316 
O08 0 ee 316 
1037. -Tn 316 
0 OO OE OO OO CT OE TN 318 
车 328 
FO SO ee 332 
1035 nd 334 
TO 5 0 344 
WO A 0 ed ee a 344 
TO 2 ED 345 
WU 345 
TU 345 
RS 证 DN ed 345 
人 346 
第 11 章 壁面 清洁 智能 机 器 人 .es 347 
(首都 高 校 第 六 届 机 械 创 新 设计 大 赛 一 等 奖 ，2012 年 .Ne 347 
PT: HE ed a 347 
11.2 ”作品 概述 .es 348 
2 0) 2 348 
D0 ee 2 ee EI OO TO OO OO ROI EO OE 348 
二 349 
AN 349 
人 357 
D3 3 So 359 
1 Hd 362 
本 本 大 362 
人 2 入 仆 全 和 生生 全 人 和 和 生 和 信人 本 生生 信和 人 362 
本 和 相 363 
Ts 363 
ES “人 必 轴 应 用 次 国信 人 昭 分 [acoso AOUAUAOALACL LOUUOUROUUCOCOAORUOUOO 363 
人 364 
几 录 365 
险 李 六 型 属 带 武 机 动 平 篆 减 度 基 排 芝 站 二 刊 ER 365 
附录 轻 旬 展 尝 吉 届 动 平 合 属 市 目 动 张 委 区间 专刊 367 
附录 C ”小 型 四 履带 移动 机 器 人 驱动 装置 专利 369 






































Me DD A se en 374 
ME 1 A Le hs 383 
附录 下 多 足 式 机 器 人 是 端 压力 传感器 专利 386 
附录 GG 二 种 适用 寺 和 性 种 机 高大 的 超声 波 州 中 条 分 专 和 和 neni 389 
附录 HH 一 种 基于 模块 化 的 多 关节 链 节 式 机 器 人 专利 393 
附录 I 一 种 节肢 机 器 人 的 轮 腿 式 运动 足 设计 专利 .es 398 
附录 本 外 骨骼 穿 戴 式 健身 与 康复 机 专利 404 
附录 KK 穿戴 式 腰 背 部 健身 与 康复 机 专利 .4 415 
附录 工 室内 高 处 空间 物品 存放 及 管理 系统 专利 000 422 
附录 M 履带 吸盘 式 壁 面 清洁 机 器 人 专利 .0 427 
附录 N 一 种 可 用 于 扑 壁 机 占 人 的 履带 吸盘 组 合式 行走 北 置 设计 专利 .0 433 





第 1 章 ”新 型 多 用 途 反 恐 防 肾 机 器 人 


(第 一 届 全 国 大 学 生 创新 年 会 “我 最 喜爱 的 10 个 项 目 ,排名 第 一 ，2008 年 ) 


[和 作品 研究 的 背景 及 意义 


上 前， 世界 各 国 尤 其 是 发 达 国 家 都 十 分 重视 对 反 钨 机 右 人 的 研究 ， 而 其 中 研究 最 多 的 是 
有 反恐 排 爆 机 各 人 ， 它 主要 用 于 代 蕉 专业 人 员 直 接 在 事 发 现场 进行 侦察 、 勘 探 、 排 除 和 处 理 焊 
炸 物 等 危险 品 ， 有 时 也 对 友 怖 分 子 或 犯罪 分 子 实 施 有 效 的 攻击 ， 是 专业 反 鸭 队伍 中 必 不 可 少 
的 重要 猜 备 。 

与 国内 外 相关 机 器 人 以 “ 排 爆 ”功能 为 主 的 设计 理念 不 同 ， 本 作品 研究 的 是 一 种 新 型 多 
用 途 反 巧 防暴 机 器 人 ， 突 出 “ 防 骏 作业 ”和 “巡逻 警戒 ”两 大 功能 ， 力 求 在 履带 式 移动 平台 
设计 技术 、 三 维 虚 拟 现实 结构 造型 技术 、 午 块 化 结构 设计 技术 、 局 精度 电动 机 控制 技术 、 大 
功率 驱动 传动 技术 、 远 距离 无 线 通信 搁 术 、 大 场景 视觉 监测 技术 、 多 任务 实时 处 理 拉 术 、 铅 
酸 动力 电 字 组 技术 等 方面 取得 突破 ， 研 制 一 种 新 型 履带 式 多 系统 、 多 功能 、 多 用 途 无 人 操控 
的 反 巧 机 如 人 。 该 机 器 人 采用 大 蕊 率 无 刷 直 流体 服 电动 机 驱动 ， 配 备 有 集成 化 车 载 微机 系统 、 
还 距离 无 线 通 信 系统 、 大 场景 视觉 监 测 系统 、 多 任务 实时 处 理 系统 及 防 芭 几 发 射 如 ， 可 运载 
有 效 负 和合 ， 完 成 在 复 林 地 形 下 的 局 效 运 动 ， 并 可 一 次 携 市 多 枚 管用 特种 防 骏 弹 ， 完 成 巡 逆 管 
不 、 反 如 防暴 的 任务 。 该 机 器 人 可 在 文艺 演出 、 体 育 欧 赛 、 群 众 集会 等 人 口 密集 的 场合 或 交 
通 枢纽 、 信 息 中 心 、 政 府 机 关 等 场所 进行 安全 保卫 或 事态 防范 工作 ， 能 够 针对 如 集会 、 游 行 、 
请 愿 、 示 威 等 人 员 密 集 、 情 绪 激 局 的 场合 可 能 暴发 的 失控 、 又 乱 等 情况 提供 快速 、 有 效 的 控 
制 和 反 制 手段 。 

在 敏感 区 域 出 现 的 全 副 武 疙 的 安保 人 员 不 仅 会 无 形 中 增加 紧张 气氛 ， 也 会 造成 安保 人 员 
的 需求 缺口 ， 而 同样 能 执行 监视 、 巡 你 及 快速 反应 任务 的 新 型 反 仅 防暴 机 如 人 不 仅 更 具有 亲 
和 力 ， 还 有 利于 维持 和 谐 的 氛围 ， 奉 大 批量 投放 还 能 吹 补 安 你 人 员 需 求 的 缺口 。 在 需要 快速 
反应 的 防暴 作业 时 ， 坚 固 耐 用 的 机 堪 人 不 仅 能 有 效 地 完成 各 项 作业 ， 也 能 保证 安 休 人 员 的 人 
喘 安 全 ， 还 能 避免 流血 事件 ， 防 止 冲突 升级 。 

目前 ， 我 国 的 反 芽 防 骏 机 器 人 研究 虽然 已 取得 很 大 的 成 绩 ， 但 仍 处 于 样机 研究 阶段 ， 还 
没有 投入 实战 ， 且 产量 少 还 不 能 满足 大 量 朔 备 的 需求 ， 应 用 经 验 还 比较 缺乏 ， 因 此 进行 新 型 
多 用 途 反 私 防 暴 机 器 人 的 技术 研究 有 着 突出 的 现实 意义 。 由 于 其 集成 了 机 器 人 行走 技术 、 传 
感 左 技术 、 信 息 处 理 技术 、 控 制 技术 、 通 信 撤 术 、 导 航 与 定位 扩 术 、 执 行 与 搭载 技术 、 模 医 
化 结构 设计 技术 、 张 动 传 动 技术 、 大 场景 视觉 检 训 技术 、 多 任务 实时 处 理 技术 等 诺 多 技术 ， 
并 可 发 射 催泪 弹 、 内 交 弹 、 染 色 弹 等 多 种 弹药 ， 对 于 机 器 人 技术 研究 、 维 护 社 会 治安 、 反 荡 
防 骏 、 和 车 事 行动 都 有 重要 作用 ， 有 痢 广阔 的 应 用 前 景 。 
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作品 概述 





1.2.1 研究 内 容 概述 

新 型 多 用 途 反恐 防暴 机 器 人 分 为 作业 端 和 操控 端 两 部 分 ， 由 七 大 系统 组 成 ， 分 别 为 履带 
式 车 载 平 台 系 统 、 视 觉 监 测 系统 、 运 动 控制 系统 、 无 线 通 信 系 统 、 能 源 动 力 系统 、 武 器 发 射 
系统 及 人 机 交互 系统 。 新 型 多 用 途 反 恐 防暴 机 器 人 的 系统 构成 图 如 图 1-1 所 示 。 





新 型 多 用 途 反 奴 防 暴 机 器 人 
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图 1-1 独 型 多 用 途 反 恐 防 到 机 旧 人 的 系统 构成 图 


1. 乃 市 式 车 载 平 台 系统 
狐 型 多 用 途 反 杷 防暴 机 占 人 的 履 融 式 和 车载 平台 系统 由 平台 机 刁 、 平 台 机 部 、 履 和 市、 承重 
轮 、 张 紧 轮 、 悬 挂 系 统 、 张 标 轮 位 置 调节 系统 等 组 成 ， 其 设计 效果 的 好 坏 和 直接 影响 机 需 人 的 
动力 性 能 和 宕 ”效果 。 考 处 到 国内 外 小 型 反恐 机 右 人 大 多， 不 能 真正 起 a 到 反 榴 防 骏 及 压制 许 
的 效果 ， 在 开展 车 载 平 台 的 结构 设计 时 ， 一 是 注 章 平台 外 观 的 瑚 ”效应 ， 研 发 具有 实际 应 
用 价值 、 能 够 起 到 反 私 震 效果、 真正 在 战场 作战 中 有 优 民 表现 的 平台 ; 三 古 为 反 奴 作战 服 
务 ， 使 平台 在 战场 复 洒 条件、 恶劣 环境 下 仍 能 够 保持 局 效 运动 。 因 此 该 系统 主要 研究 局 性 能 
履 市 式 移动 平台 的 结构 造型 与 仿真 ， 并 能 够 在 目前 已 研制 成 功 的 履带 式 平 台 的 基础 上 开拓 创 
刹 ， 设 计 研 究 更 局 质量 和 性 能 的 机 右 人 移动 平台 。 
2. 机 器 人 视 完 监 测 系 统 
机 器 人 视觉 监测 系统 的 设计 任务 为 : 对 战场 环境 能 够 进行 大 场景 观测 ， 实 时 传输 战场 
情况 图 像 ， 使 操控 者 能 够 根据 战场 情况 做 出 判断 ， 调 整 控 制 策 略 ， 并 能 够 。 使 用 ， 打 破 常 
规 机 器 人 晚 无 法 使 用 的 限制 ， 凶 具有 看 准 功 能 ， 能 够 随 防 骏 弹 发 财 占 的 运动 调整 监 汕 
场景 ， 有 效 地 发 现 目标 、 锁 定 目 标 、 盯 准 目标 ， 提 融 防 暴 弹 发 映 炊 度 ，() 能 够 对 机 絮 人 所 行 
走 的 路 面 情况 进行 实时 监测 ， 并 能 够 使用， 保证 机 器 人 能 够 有 效 选择 有 利 地 形 、 地 势 行 
进 ， 你 证 作战 任务 的 顺利 进行 。 
在 这 些 需求 下 ， 新 型 多 用 途 反 候 防 骏 机 吉 人 采用 三 路 视频 采集 机 制 ， 视 党 监测 系统 包括 
大 场景 检测 远 红 外 摄像 状 、 防 驼 弹 发 射 上 临 准 远 红 外 摄像 凑 、 机 器 人 前 站 路 面 监 测 远 红 外 摄像 
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头 、 视 频 采 集 卡 、 视 频 无 线 发 送 模块 、 视 频 无 线 接 收 模块 。 视 频 无 线 收 发 模块 使 视频 传输 与 
控制 指令 的 无 线 传输 分 离开 来 ， 保 证 了 各 种 无 线 信 号 传输 的 实时 性 ， 有 力 地 提升 了 机 器 人 视 
觉 监测 的 效果 。 研 究 重 点 是 视频 图 像 捕 捉 算 法 、 实 时 高 效 的 图 像 传 输 及 视觉 监测 系统 与 各 系 
统 的 有 机 集成 。 

3. 运动 控制 系统 

机 器 人 运动 控制 系统 是 机 器 人 具备 优良 运动 能 力 的 可 靠 保 证 ， 其 主要 部 件 包括 两 台大 功率 无 
刷 直流 电动 机 及 其 驱动 堪 、 两 台 步 进 电 动机 及 其 驱动 器 、 机 器 人 主 控 计 算 机 、 减 速 问 和 驱动 轮 等 。 
主 探 计算 机 为 机 器 人 的 核心 控制 部 件 ， 控 制 策 略 的 研究 、 选 择 及 其 实现 是 机 堪 人 实现 多 功能 、 多 
用 途 的 关键 ; 直流 150V 供电 的 大 功率 无 刷 直流 电动 机 确保 了 机 器 人 强 ”的 动力 性 能 ， 以 色 列 
ELMO 数字 伺服 电动 机 张 动 器 配 有 API 函数 库 使 控制 编程 简单 方便 ; 毅力 窍 为 SON。m 的 步 进 电 
动机 能 够 你 证 发 射 器 在 携 高 多 枚 防暴 弹 时 灵活 转动 ， 在 全 空间 范围 内 对 敌 目 标 进行 瞄准 并 实施 攻 
击 ， 同 时 步 进 电动 机 成 本 低 、 探 制 简 单 ， 共 有 很 大 的 实用 价值 和 研究 意义 。 

4. 无 线 通信 系统 

无 线 通 信和 系统 由 无 线 网 桥 和 天 线 构成 ， 机 器 人 控制 指令 的 收发 均 通 过 该 系统 完成 。 为 保 
证 控制 指令 的 无 差错 、 无 延 时 传输 ， 必 须 配 备 高 性 能 的 无 线 局 域 网 收发 装置 ， 因 此 无 线 局 域 
网 装置 的 选择 及 网 络 编程 中 的 有 关 协 议 成 为 该 系统 研究 的 重点 。 美 国 Axelwave 局 域 网 专业 公 
司 生产 的 AX9000PE-30 无 线 网 桥 及 XA-212 天 线 以 其 出 色 的 性 能 保证 了 该 机 器 人 控制 的 实时 
性 ， 为 高 性 能 无 线 控制 反 多 防暴 的 研究 积累 了 经 验 。 

S， 机 器 人 能 源 动力 系统 

机 器 人 能 源 动力 系统 采用 电池 供电 的 方式 ， 摆 肪 了 传统 拖 统 供电 带 来 的 不 便 ， 使 新 型 多 
用 途 反 榴 防 骏 机 器 人 可 真正 实现 野外 作战 。 能 源 动力 系统 是 机 器 人 的 “ 心 ”， 人 负责 各 个 系统 
的 电力 供应 ， 为 保证 机 器 人 稳定 运行 ， 电 力 供 应 的 稳定 是 关键 环节 ， 必 须 投 入 充裕 的 人 力 、 
物力 加 以 研制 。 在 供电 任务 中 ， 主 要 有 150V 直流 大 功率 无 刷 直流 电动 机 驱动 器 供电 、48V 直 
流 步 进 电 动机 驱动 器 供电 、24V 直流 无 线 网 桥 供电 、24V 警 灯 供电 、12V 直流 主板 供电 、12V 
直流 视觉 监测 摄像 头 供电 、12V 直流 视频 无 线 收 发 模块 供电 及 机 器 人 专用 操控 箱 的 交流 供电 。 
由 于 机 器 人 由 多 系统 组 成 ， 增 加 了 复杂 性 ， 因 此 电源 电路 设计 、 电 气 设 计 、 布 线 与 确保 电气 
接口 安全 、 确 保 动 力 系统 安全 成 为 能 源 动力 系统 研究 的 关键 。 

6. 武器 发 射 系统 

武 占 发 射 系统 由 防暴 弹 发 映 器 、 特 种 弹药 、 弹 药 箱 及 发 射电 源 组 成 ， 是 新 型 多 用 途 反 多 
防暴 机 器 人 执行 有 反 多 防暴 任务 的 作业 系统 ， 特 点 是 远 距 离 、 跟 区 域 打击 。 武 右 发 射 系统 主要 
研究 防暴 弹 发 射 右 的 结构 造型 、 仿 真 及 加 工 ， 特 种 弹药 模型 的 造型 、 仿 真 及 加 工 ， 并 涉及 防 
去 弹 上 友 射 触发 式 电 源 。 因 防 骏 阐发 射电 源 触发 模块 有 一 僚 相 关 的 军用 标准 ， 有 成 品 可 供 选 择 ， 
所 以 并 不 是 本 作品 的 研究 重点 。 

7. 人 机 交互 系统 

人 机 交互 系统 是 进行 机 器 人 控制 的 重要 装置 。 操 控 人 员 需 要 通过 操控 端的 液晶 显示 器 了 
解 战场 情况 ， 并 做 出 控制 指令 的 判断 ， 进 而 操控 机 器 人 做 出 相应 的 动作 。 为 此 需要 研究 友好 
的 用 户 操作 界面 ， 并 结合 机 器 人 多 任务 、 多 系统 的 特点 ， 制 定 有 效 的 控制 策略 ， 简 化 开发 程 
序 的 代码 ， 稍 化 操控 面板 的 设计 ， 同 时 还 要 做 到 低 成 本 。 为 此 没有 使 用 市 场 上 价格 昂 贯 的 工 
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控 机 操控 箱 ， 目 主 开 及 了 专用 于 “新 型 多 用 途 反 鸭 防 玛 机 融 人 ”的 操控 箱 ， 既 锻炼 了 制作 者 
的 能 力 ， 又 降低 了 成 本 。 


1.2.2 ”技术 指标 


狐 型 多 用 途 反 恐 防暴 机 器 人 的 技术 指标 如 下 : 

1) 新 型 多 用 途 反 恐 防暴 机 器 人 长 1230mm， 宽 650mm， 高 SS0mm， 目 重 180kg， 可 携带 
有 效 载 傈 120kg。 

2) 机 袁 人 巡航 速度 为 60m/min， 了 最 大 速度 为 72m/min， 可 在 日 地 、 沙 滩 等 复杂 路 面 上 行 
走 ， 攀 和 仆 40” 斜坡， 翻越 30cm 高 障碍 ， 并 能 快速 上 下 高 为 20cm 以 下 、 和 斜 度 为 33$” 的 合 阶 。 

3) 可 依靠 两 履带 的 差 速 转动 实现 快速 转 癌 或 原 地 转 癌 ， 转 要 半 径 小 于 平台 长 度 ， 保 证 机 
器 人 快速 、 高 效 、 稳 定 的 运动 。 

4) 车 载 无 线 通信 系统 可 保 隐 在 3000m 范围 内 进行 无 线 岁 像 信号 的 可 靠 传 输 和 运动 控制 信 
号 的 有 效 传递 。 

5) 配备 三 路 远 红 外 摄像 次， 视觉 监测 系统 可 对 周围 360” 范围 内 的 情况 进行 实时 监视 ， 
并 具有 ” 视 功 能 ， 可 在 “ 间 搜 索 和 锁定 目标 ， 有 效 像素 为 768 〈H) x494 〈V)， 水 平分 辨 座 为 
470 (TV Lines )。 

6) 防暴 弹 发 射 占 一 次 可 装填 23 枚 特种 防暴 阐 ， 弹 种 包括 催泪 弹 、 闪 光 弹 、 染 色 弹 、 

弹 、 橡 胶 弹 、 弹 、 痛 球 阐 、 焊 震 弹 等 多 种 弹药 ， 可 有 效 对 政 实施 打击 。 

7) 防暴 弹 发 射 器 可 在 水 平和 垂直 两 个 方向 上 灵活 运动 ， 水 平 最 大 旋转 角度 为 180”， 重 
直 最 大 俯仰 角度 为 45”， 配 备 远 红外 瞄准 摄像 头 ， 并 可 在 ” 间 瞄 准 敌 方 目标 。 

8) 电源 系统 采用 铅 酸 电池 组 供电 ， 供 电 时 间 为 1~~3h， 具 备 强 ”的 电源 动力 性 能 。 

9) 便携 式 操控 箱 长 416mm， 宽 360mm， 高 186mm， 配 备 12in 液晶 显示 屏 ， 可 同时 显示 
三 路 视觉 监测 视频 ， 可 进行 多 路 视频 回放 ， 并 可 根据 情况 对 其 中 一 路 进行 全 屏 显 示 ， 探 制 界 
面 友好 、 人 简单 ， 实 用 性 强 ， 配 备 方 癌 操作 遥控 杆 ， 可 对 机 器 人 和 车载 平台 、 防 双 弹 发 射 器 云 台 
和 大 场景 监测 摄像 头 进 行 转 问 控制， 便携 式 操控 箱 采 用 220V 交流 供电 。 




































































1.3.1 结构 造型 技术 


狐 型 多 用 途 反 您 防 骏 机 帮 人 的 机 械 霹 型 采 
用 PRO/E 造型 软件 设计 , 进行 了 三 维 虚拟 现实 仿 
真 、 性 能 分 析 、 加 工 制造 等 诸多 工作 ， 使 机 融 人 
的 运动 性 能 有 可 靠 的 保证 。 结 构造 型 设计 主要 分 
为 机 动 平 台 造 型、 有 友 射 磊 云 合 造型 和 防 骏 弹 及 射 
铸造 型 三 部 分 ， 组 竣 〈 未 加 ” 彩 设 计时 ) 后 的 机 
促 人 实物 网 如 图 1-2 所 示 。 其 中 轻型 履带 机 动 平 
台 减 晨 惹 挂 朔 置 、 履 带 目 动 张 紧 装置 、 大 功率 负 
载 云 台 疙 置 是 机 莫 人 机 械 部 分 的 三 大 腕 点 。 图 1-2 组 北 后 的 机 费 人 实物 图 
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1， 轻 型 履 市 式 机 动 平 台 减 震 悬 挂 才 置 

履 市 式 移动 平台 的 减 震 感 挂 猴 置 主要 用 于 连接 平 合 负重 轮 与 车 体 ， 起 到 改善 平台 机 动 性 能 和 
调节 履 囊 张 双 程度 的 作用 。 目 前 ， 普 通 的 履带 式 和 车 辆 一 般 采 用 液压 、 气 压 、 扭 杆 弹 茧 等 过 挂 装置 ， 
而 这 些 芒 挂 北 首 因 体积 庞大 、 结 构 复 淮 、 成 本 融 郧 等 缺点 ， 不 利于 直接 移植 到 轻型 履带 式 机 动 平 
全 上 。 现 有 的 轻型 履带 式 机 动 平 台 巷 挂 系统 往往 采用 直接 的 刚性 连接 或 者 简易 的 减 形 巷 挂 装置 ， 
里 然 结构 人 简单、 成 本 低 廉 ， 但 减 宕 效果 较 又 ， 不 能 适应 轻型 履带 式 机 动 平台 噩 速 越野 机 动 的 实际 
需要 。 此 外 ， 现 有 的 轻型 履 市 式 机 动 平 台 惹 挂 猴 置 功能 单一 ， 缺 乏 几 余 度 与 履 融 张 紧 的 调节 能 力 ， 
这 些 者 制约 了 轻型 履 市 机 动 平 全 及 履 市 式 移 动机 严 人 机 动 性 能 的 发 挥 。 

针对 现 有 惹 挂 朔 置 在 结构 、 体 积 、 功 能 及 成 本 等 方面 的 缺点 ， 设 计 了 一 种 能 够 适应 轻型 
履带 式 机 动 平台 噩 速 越野 机 动 要 求 的 可 调式 减 形 葵 挂 冷 置 ， 其 结构 示意 图 如 图 1-3 所 示 。 










































































图 1-3 减 寡 葵 挂 站 症 结构 示意图 
a) 整体 结构 示意 图 b)》 弹 得 减 震 组 件 分 解 结构 示意 图 
1 一 直线 运动 球 轴承 ”2 一 螺旋 弹簧 ”3 一 承重 轮 4 一 销 轴 5 一 橡胶 热 。”6 一 承重 轮轴 7 一 承重 轮 连 杆 
8 一 T 形 转动 支架 9 一 导向 移动 轴 10 一 矢 挂 装置 固定 座 11 一 限 位 调节 螺母 ”12 一 调节 垫圈 

两 根 承 重 轮 轴 6 穿 过 承 乍 轮 连 杆 7 两 应 的 通 孔 ， 承 重 轮 3 对 称 安 状 在 承重 轮轴 6 的 两 站 
承重 轮 连 杆 7 与 工 形 转动 文 录 8 通过 销 轴 4 在 连 杆 中 点 贸 接 ， 使 得 纵 问 布置 的 承重 轮 组 件 在 
通过 朵 邮 路面 时 可 以 根据 地 形 起 伏 肥 生 偏 转 ， 从 而 均匀 分 配 地 面 对 蕊 挂 系 统 的 冲击 ; 工 形 转动 
文 架 8 的 上 部 两 端 竖 直 插 入 叶 罕 螺旋 弹 算 中 心 线 的 两 根 导 同 移 动 轴 9, 导 同 移动 轴 9 的 上 妆容 
过 巷 挂 状 置 固定 座 10， 并 在 项 靖 痛 有 限 位 调节 岗 峡 11， 导 问 移 动 轴 9 和 巧 挂 闻 置 固定 座 10 
之 间 装 有 再 线 运动 球 轴承 1, 该 轴承 在 确保 轴 辣 相对 运动 精度 的 同时 , 可 降低 零件 的 摩擦 损耗 ; 
悬挂 装置 问 定 座 10 与 T 形 转动 文 染 8 共同 限制 了 螺旋 弹 侍 2 的 轴 加 位置， 构成 了 巧 挂 系统 的 
弹 时 减 震 组 件 。 当 机 动 平台 通过 师 虹 路 向 时 ， 导 癌 移 动 轴 9 与 悬挂 装置 固定 座 10 产生 相对 位 
移 ， 蝶 旋 弹 性 2 受 压 变 形 ， 吸 纳 能 量 ， 实 现 减 震 ， 巧 挂 猴 置 回 定 座 10 通过 四 个 螺栓 辕 定 在 机 
动 平 台 压 税 侧 壁 上 ， 实 现 了 巷 挂 疙 前 的 模块 化 配置 ， 便 于 整体 装 凶 ， 且 定位 牢固 可 徘 。 蝶 放 
弹 费 2 与 转动 文革 8 之 间 及 限 位 调节 螺母 11 与 悬挂 装置 固定 座 10 之 间 状 有 夺 干 调 市 垫 闭 12， 
通过 增 减 垫 奖 的 数量 与 厚度 ， 可 以 调节 悬挂 系统 刚度 和 履 融 张 紧 程 度 。 

该 减 展 上 巧 挂 鹤 置 上 共 有 以 下 优点: 
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1) 在 轻型 履带 式 机 动 平台 通过 崎 虹 路 面 时 ， 悬 挂 装 置 通过 弹 得 变形 与 转动 支架 摆动 实现 
双重 减 震 ， 可 有 效 提高 轻型 履带 式 机 动 平 台 的 越 障 能 力 与 行驶 稳定 性 。 

2) 悬挂 装置 具有 民 好 的 调节 功能 ， 可 根据 需要 调整 悬挂 系统 的 刚度 和 履带 的 张 紧 程 度 ， 
日 操作 方便 ， 机 动 灵活 。 

3) 使 用 直线 运动 球 轴 承 ， 在 确保 轴 向 相对 运动 精度 的 同时 ， 降 低 了 零件 的 摩擦 损耗 。 

4) 悬挂 装置 与 机 动 平台 的 连接 方式 简单 、 牢 回 ， 实 现 了 巧 挂 系统 的 模块 化 设计 ， 可 广泛 
应 用 于 各 种 轻型 履带 式 机 动 平 台 和 履带 式 移动 机 器 人 。 

2. 履带 自动 张 紧 装 置 

履带 式 机 动 平台 或 履带 式 车 辆 多 在 全 天 候 和 全 路 况 条 件 下 使 用 ， 作 业 环 境 的 恶劣 性 和 作 
业 任务 的 艰巨 性 ， =- 定 的 塑性 伸 长 ， 为 了 适应 上 述 伸 长 ， 保 
持 履 带 的 驱动 力 ， 一 般 都 必须 设置 履带 张 紧 装 本 赤 置 具有 可 在 履带 上 实现 调节 并 
保持 适当 张 紧 力 的 功能 we ne 结构 示意 图 如 图 1-4 所 示 ， 它 在 机 
动 平台 上 的 安装 位 置 如 图 1-5 所 示 。 该 装置 是 一 种 适用 于 轻型 履带 式 机 动 平台 或 微小 型 履带 
式 车 辆 的 履带 自动 张 紧 装 置 ， 结 构 简 单 、 功 能 可 靠 、 性 能 稳定 ， 不 但 能 够 方便 地 调节 履带 的 
张 紧 程度 ， 而 且 在 履带 弹性 伸 长 范围 内 还 具有 一 定 的 自动 张 紧 功 能 





















































1 证 是 


让 四 < 
出 S 





图 1-4 履 市 日 动 张 案 疡 症结 构 示 意图 
1 一 弹簧 导 轴 座 ”2 一 导向 轴 座 ”3 一 直线 运动 球 轴承 4 一 支撑 轴 座 
5 一 导 问 轴 6 一 螺栓 7 一 预 紧 座 8 一 文 撑 轴 9 一 弹 贰 ”10 一 弹 申 导 轴 ”11 一 弹 竹 调 市 座 
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图 1-5 轻型 履 市 式 机 动 平台 整体 布局 示意 图 
1 一 车 体 2 一 从 动 轮 3 一 履带 


履 市 张 标 姜 置 由 预 张 紧 组 件 和 目 适 应 张 紧 组 件 构 成 。 预 张 紧 组 件 主要 包括 导 问 轴 座 2、 和 直 
线 运 动 球 轴承 3、 文 撑 轴 座 4、 导 疝 轴 5、 预 紧 座 7、 弹 算 调 市 座 11 等 。 直 线 运动 球 轴承 3 分 
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别 插 入 支撑 轴 座 4 两 端的 圆 也 中， 并 用 弹 和 车 挡 轿 固定 ， 两 个 导 回 轴 5 罕 入 两 个 直线 运动 球 轴 
承 3 的 内 座 背 ， 直 线 运 动 球 轴承 3 在 导 同 轴 5 上 活动 目 如 ， 在 导 问 轴 SS 的 两 端 各 装 上 导 问 轴 
座 2, 并 用 内 六 角 螺 钉 把 导 问 轴 座 2 国定 在 车 体 1 上 从 动 轮 安装 位 置 处 的 后 面 , 弹 竹 调 厄 座 11 
位 于 文 撑 轴 座 4 的 左 侧 ， 预 紧 座 7 位 于 文 撑 轴 座 4 的 右 侧 ， 二 者 均 用 内 六 角 螺 钉 固 定 在 车 体 1 
上 。 目 适应 张 紧 装 置 包括 弹 晤 9、 弹 车 导 轴 10 和 弹 敬 导 轴 座 1， 弹 千 9 套 在 弹 敬 导 轴 10 的 外 
部 ， 弹 车 导 轴 10 固定 在 弹 先导 轴 座 1 上 。 

通过 调节 螺栓 6 旋 入 弹 竹 调 座 11 和 了 预 紧 座 7 的 深度 可 确定 一 个 预 张 紧 区 间 ， 使 文 撑 轴 
座 4 在 这 个 区 间 内 运动 ， 而 弹 千 9 和 弹 营 导 轴 座 1 可 以 使 整个 装置 在 此 区 间 内 其 有 一 定 的 目 
适应 张 么 力 调 节 功 能 。 当 有 外 力 迫 使 履带 伸缩 时 ， 文 撑 轴 座 4 残 会 压缩 弹 营 9， 从 而 改变 从 动 
轮 2 的 位 置 确 保 履带 3 的 张 紧 值 ; 当 外 力 消失 后 ， 弹 绰 9 将 文 撑 轴 座 4 推 回 原来 的 位 置 ， 使 
履带 3 恢复 到 原 有 的 状态 ， 这 样 履 珊 3 的 张 紧 程 度 将 维持 在 合适 范围 内 ， 保 证 轻型 履带 式 机 
动 平 台 或 微小 型 履 市 式 车 辆 的 正 芝 行驶 。 

3. 大 功率 负载 云 台 效 置 

大 功率 负载 云 台 闭 置 是 由 两 个 电动 机 组 成 的 运动 平台 ， 可 以 实现 水 平方 向 和 垂直 方 癌 的 
全 方位 运动 。 内 部 的 两 个 电动 机 分 别 负 责 云 侣 的 上 下 和 左右 各 方 癌 的 转动 。 当 上 、 下 动作 闭 
置 通电 时 ， 竺 直 电动 机 转动 ， 经 减速 钱 置 带动 牌 百 传动 轮 盘 转动 ; 当 左 、 石 动作 装置 通电 时 ， 
水 平 电动 机 转动 并 经 减速 器 珊 动 云 台 底部 的 水 平 转动 盘 转 动 。 

结合 新 型 多 用 途 反 芍 防 暴 机 器 人 的 设计 意图 与 功能 要 求 ， 冯 先 制定 云 台 的 设计 性 能 指标 ， 
主要 包括 : 云 侣 的 转动 速度 〈 包 含水 平 转速 和 垂直 转速 )、 云 台 的 转动 角度 、 云 侣 的 载重 量 、 
回 者 、 可 徘 性 及 使 用 环境 指标 。 明确 云 台 的 功能 和 造型 任务 后 , 运用 PovE 和 Autodesk Inventor 
进行 机 械 造 型 设计 。 首 先 ， 确 定 儿 个 关键 的 轴 系 : 承重 和 定位 回转 中 心 的 下 主轴 、 负 责 水 平 
回转 动力 的 下 蜗轮 轴 、 负 贡 竺 直 回 转动 力 的 上 蜗轮 轴 及 上 蜗轮 连接 的 ” 轴 。 整 套 机 构 在 水 平 
器 转 上 采用 山 轮 蜗杆 侧 置 ， 在 垂直 信仰 上 玉 用 蜗杆 下 置式 。 

下 主轴 在 整个 系统 中 最 为 天 键 ， 逆 上 蜗轮 的 下 主轴 整体 结构 如 几 1-6 所 示 。 在 下 主轴 的 
上 新 设计 有 M50 的 大 螺纹 ， 用 一 个 垫 净 置 于 深 沟 球 和 轴承 内 较 ， 满 足 轴 友 文 择 条 件 ， 再 用 一 个 
大 螺母 锁 紧 达到 固定 整个 下 转动 机 件 相 对 位 置 关 系 的 目的 。 

在 车 体 上 新 纵深 方 则 上， 安置 蜗杆 及 电动 机 部 件 。 电 动机 广 座 和 下 转动 部 件 的 三 维 狼 配 
图 如 图 1-7 所 示 。 电 动机 文 座 与 申 杆 的 后 端 文 撑 整合 成 一 个 零件 。 这 样 既 减少 了 转动 部 件 的 








































































































图 1-6 下 主轴 整体 结构 图 1-7 电动 机 支 座 和 下 转动 部 件 的 三 维 装配 图 
整个 上 信仰 部 件 是 构建 在 一 块 与 下 转动 部 件 连接 的 基 极 之 上 的 。 采 用 与 下 蜗杆 后 并 的 文 
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撑 处 理 相 似 的 电动 机 文 座 ， 为 了 加 工 方便 ， 在 电动 机 选 型 上 优先 考虑 傅 仰 部 件 市 动 的 负载 的 
起 动 转 矩 ， 将 上 下 电动 机 及 电动 机 文 座 统一 成 一 种 型 号 ， 这 样 可 降低 控制 电动 机 的 难度 。 上 
俯仰 部 件 的 三 维 装配 图 如 图 1-8 所 示 。 

上 蜗轮 选用 届 形 蜗轮 ， 并 根据 云 台 的 信仰 角度 确定 届 形 的 大 小 。 由 于 蜗轮 上 置 ， 蜗 杆 的 
另 一 史 和 上 蜗轮 轴 的 文 撑 就 成 为 了 上 信仰 部 件 设 计 的 关键 。 在 上 蜗轮 轴 对 应 链接 的 负载 是 通 
过 两 个 支撑 耳 与 友 射 染 实现 的 ， 因 此 还 要 涉及 两 端 轴承 的 安 冯 和 国定 。 蜗 轮轴 两 端 加 工 成 六 
棱 形 ， 如 图 1-9 所 示 。 与 发 射 架 文 撑 耳 组 装 ， 既 使 其 安装 方便 ， 又 保证 了 蜗轮 轴 与 支撑 耳 所 
连接 的 负载 运动 一 致 。 








图 1-8 ”上 俯仰 部 件 的 三 维 装配 图 图 1-9 蜗轮 轴 


对 于 整套 机 械 结构 的 密封 ， 鉴 于 机 磊 人 的 工作 环境 较为 复杂 ， 采 用 饭 金 件 外 部， 这 样 既 
为 作品 增加 了 美感 ， 又 能 满足 相应 的 密封 要 求 。 从 工学 美感 的 角度 出 发 ， 将 下 转动 部 件 的 饭 
金 ”设计 成 “前 圆 后 方 ” 并 以 下 主轴 中 线 分 开 ， 便 于 拆 荫 和 加 工 ， 下 转动 部 件 的 饭 金 件 外 元 
如 图 1-10 所 示 。 对 于 上 和 作 仰 部 件 ， 依 照 部 件 的 形状 设计 上 俯仰 部 件 的 元 体 ， 所 设计 的 上 俯仰 
部 件 的 饭 金 件 外 元 如 图 1-11 所 示 。 








图 1-10 下 转动 部 件 的 饭 金 件 外 过 


4. 负载 发 射 器 造型 

防暴 弹 发 射 句 和 防暴 弹 模 型 的 设计 、 造 型 与 仿真 均 投 有 天竺 用 标准 进行 ， 采 用 Pro/E 
等 实体 造型 软件 完成 了 三 维 建 模 和 图 样 绘制 工作 。 图 1-12 所 示 为 防洪 图 发 射 右 的 三 维 造 型 岁 。 
该 结构 造型 不 但 可 以 实现 相应 功能 ， 而 且 威 武 雄 壮 ， 上 其 有 很 强 的 震 ” 力 。 集 成 的 发 射 系统 
为 电 触 发 ， 后 部 有 电 触 发 冯 置 ， 前 部 人 工 北 十 ， 一 系列 控制 指令 及 电路 为 成 熟 技 术 可 和 朋 接 


采用 。 
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图 1-12 ”防暴 阐发 射 俘 三 维 造型 图 


1.3.2 ”机 器 人 视 完 技术 


机 器 人 视觉 监测 系统 是 利用 机 需 视 觉 代 和 谷 人 眼 来 做 各 种 测量 和 判断 ， 通 过 视觉 传 感 硕 获 
取 环 境 的 二 维 图 像 ， 并 通过 视觉 处 理 喜 进行 分 机 和 解释 ， 进 而 转换 为 符 喜 ， 让 机 磊 人 能 够 辩 
识 物体 ， 并 确定 其 位 置 。 一 般 包 括 照明 系统 、 镜 头 、 摄 像 系统 和 图 像 处 理 系统 ， 是 机 器 人 系 
统 中 不 可 缺少 的 组 成 部 分 。 根 据 新 型 多 用 途 反 灵 防 又 机 器 人 的 用 途 ， 要 求 其 在 视觉 方面 能 对 
前 进 路 况 进行 有 效 探 合 、 对 特殊 目标 能 够 有 效 上 胸 准 、 对 整体 环境 能 够 充分 把 握 、 对 特定 目标 
能 够 准确 识别 。 在 以 上 四 个 方面 的 要 求 下 结合 机 器 人 的 和 造型、 效果、 布局 、 内 部 构造 等 进行 
机 器 人 视觉 监 测 系统 的 选 型 和 方案 论证 。 

1， 方 案 论 证 和 选 型 

由 于 一 个 摄像 头 无 法 同时 完成 目标 上 蜡 准 、 路 况 勤 测 和 场景 监视 三 项 任务 ， 需 要 多 个 摄像 
头 并 行 实行 这 三 项 任务 ， 因 此 选用 三 个 摄像 头 作为 机 郑 人 视觉 系统 的 组 成 部 分 。 邦 外 ， 三 个 
摄像 头 的 位 置 选择 对 机 噩 人 的 整体 视觉 效 末 有 看 重要 的 影响 ， 节 终 俏 定 的 摄像 头 在 机 部 人 上 
的 安放 位 置 如 图 1-13 所 示 。 这 样 的 位 置 选择 充分 利用 了 机 器 人 的 外 形 特 点 和 布局 特点 ， 使 摄 
像 尖 可 以 充分 发 挥 各 目的 作用 。 此 外 ， 三 个 摄像 尖 可 以 利用 目 映 的 特点 旋转、 信仰 ) 做 到 
全 面 的 探测 和 观 坚 ， 避 免 了 过 多 摄像 尖 增 强 图 像 处 理 的 难度 ， 同 时 又 羔 顾 了 视觉 系统 的 价格 
要 求 。 





























图 1-13 摄像头 在 机 器 人 上 的 安放 位 置 
图 1-14 为 机 器 人 视觉 监测 系统 的 组 成 图 。 一 号 、 二 号 、 三 号 摄像 头 均 选 择 无 线 传 输 ， 无 








线 摄像 头 使 用 单独 的 传输 通道 ， 不 占用 无 线 网 络 ， 减 少 了 视频 传输 对 控制 系统 的 干扰 。 视 频 
信息 通过 无 线 接收 模块 ， 将 模拟 信息 朋 接 传 到 控制 终端 。 


图 像 采 集 卡 
图 像 处 理 计算 机 





tc, 判断 和 控制 





摄像 机 ”无 线 传输 无 线 接收 


图 1-14 ”机 禹 人 视觉 监测 系统 的 组 成 图 


(1) 模拟 摄像 头 和 数字 摄像 头 的 比较 ”模拟 摄像 头 多 为 CCD 类 型 ， 不 同 档次 的 分 辨 率 不 
同 。 模 拟 摄像 头 捕 捉 到 的 视频 信号 必须 经 过 特定 的 视频 捕捉 卡 将 模拟 信号 转换 成 数字 模式 ， 
并 加 以 压缩 后 才 可 以 在 计算 机 上 运用 。 数 字 摄 像 头 是 一 种 数字 视频 的 输入 设备 ， 它 利用 光电 
技术 采集 影像 ， 通 过 内 部 的 电路 把 这 些 代表 像素 的 “点 电流 ”转换 成 为 能 够 被 计算 机 所 处 理 
的 数字 信和 号 0 和 1， 而 不 像 视频 采集 卡 那样 首先 用 模拟 的 采集 工具 采集 影像 ， 再 通过 专用 的 模 / 
数 转换 组 件 完成 影像 的 输入 。 

模拟 摄像 头 使 用 CCD 作为 感应 器 ， 成 像 质量 好 ， 但 由 于 制造 工艺 复杂 ， 价 格 较 高 ， 数 字 
摄像 头 使 用 CMOS 作为 感应 器 ， 在 相同 分 辨 率 下 ，CMOS 价格 比 CCD 低 ， 但 CMOS 堪 件 产 
生 的 图 像 质量 比 CCD 要 差 一 些 ， 日 在 分 辨 率 640x480 以 上 捕捉 速度 不 是 很 快 。 市 面 上 绝 大 多 
数 的 消费 级 别 及 高 端 数码 相机 都 使 用 CCD 作为 感应 器 ; CMOS 感应 器 则 作为 低 端 产品 应 用 于 
一 些 摄 像 关 上 。 为 了 提高 成 像 质 量 ， 作 品 选用 了 模拟 摄像 头 。 

(2) 三 个 摄像 头 的 选 型 ”对 于 一 号 和 二 号 摄像 头 ， 选 用 HM-108M 远 红外 摄像 涉 ， 如 图 
1-15 所 示 ， 其 性 能 参数 见 表 1-1。 


表 1-1 HM-108M 远 红外 摄像 头 性 能 参数 





















































型 号 HM-108M 

电源 DC12V 

摄像 元 件 SONY 1/4 Super HAD CCD 
元 作 尺 十 4.34mm (H) x3.69mm (V) 
影像 像素 512 (H) x582 (V) 

水 平 清晰 度 420TV 线 

电流 1500mA 

扫描 方式 Interiale 2:1 

视频 输出 1.0Vp-p/75Q 

镜头 规格 F=3.9~85.5mm 

聚焦 系统 目 动 聚焦 

白 平 衡 自动 平衡 ON( 开 〉 OFF ( 关 ) 
信 噪 比 过 48dB 


电子 快门 
增益 控制 

最 低 照 度 
背光 补偿 
红外 灯 规 格 
红外 照射 距离 
工作 温度 


PAL:1/50s-1/100,000s NTSC:1/60s-1/100,000s 
自动 增益 ON ( 开 ) OFF ( 关 ) 

0Lux/F1.2〈 红 外 灯 启 动 ) 

手动 /自动 可 选 

2872 Super LED 

100m 


-10~50C 〈14 一 122” 耻 ) 


三 号 摄像 头 如 图 1-16 所 示 ， 选 用 佳能 VC-C50i 摄像 头 ， 其 性 能 参数 见 表 1-2。 





型 号 

影像 感应 器 
映像 点 总 数 
水 平 解像度 
垂直 解像度 
S/N 比率 
扫描 方法 
主体 最 小 光度 
影像 模式 


摄影 机 镜头 
转动 范围 


连接 界面 


串联 控制 
对 焦 


光圈 
镜头 
红外 线 滤 


一 号 和 二 号 摄像 头 图 1-16 三 写 报 像 类 佳能 VC-C50i 


表 1-2 佳能 VC-050i 摄像 头 性 能 参数 
VC-C50i 监察 相机 
1/4CCD 
PAL 400,000 个 映像 点 
PAL:420 TV 线 
350 TV 线 
48dB 
2:1 
正常 模式 : llux (1/30s) /” 摄 模式 : 0lux 
正常 模式 摄 模式 
移动 角度 : 向 左 100”， 向 右 100° 
旋转 速度 : 1” ~90° 
倾斜 角度 : 向 上 90”， 向 下 30° 
倾斜 速度 : 1 





Video 输出 : BNC Composite video 输出 
S-Video 输出 ，RS-232C 控制 (输入 /输出 ) 
电源 (DC) 13W 
多 达 9 部 监察 相机 


自动 /手动 广角 : 0.01m 至 无 限 ， 远 摄 : 1.6m 至 无 限 

〈( 摄 模 式 ， 广 角 : 0.02m 至 无 限 ， 远 摄 : 2.3m 至 无 限 ) 
自动 光圈 调整 系统 

焦距 3.5 一 91.0mm，f1.6 一 4.0，26 倍 变焦 

设置 / 移 除 〈 正 常 模式 /” 摄 模式 ) 
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( 续 ) 
摄 模式 
白 平 衡 TTL 系统 : 自动 /手动 /一 按 式 
最 大 耗 量 约 12.5W 〈 包 括 AC 转 接 器 ) 
温度 : -0 一 40TC 
操控 环境 
湿度 : -20% 一 85$% 无 冷凝 ) 
安装 角度 +20” 水 平 (+15” 若 选 配 安装 角 变换 器 ) 
体积 100mm xl117mmx96mm 
重量 420g 
型 邱 WL-V5 
系统 红外 线 脉冲 系统 
无 线 遥 控 3W DC (2 AA 电池 ) 
体积 50mm x 175mm x 24.5mm 
量 约 79g〔 不 包括 电池 ) 
型 号 PA-V16 
输入 (AC) 100~240W,，50/60 Hz 
(DC) 13W，1.8A〔 最 高 ) 
AC 连接 器 


济 
度 


约 205g〔 不 包括 电线 ) 


(3) 无 线 收发 模块 的 选 型 ”无 线 收发 模块 如 图 1-17 所 示 。 

视频 无 线 发 射 器 参数 : 频率 : 2.4GHz; 频道 : 4; 功率; 1000mW; 距离 : 800 一 1200mi 
传送 :影音 同步 ， 电 源 : (DC) 12V/500mA; 尺寸 62mmx53mmx35mm; 重量 : 135g。 

无 线 收发 机 参数 : 频率: 2.4GHz; 频道 : 4;， 调整 : 手动 ” 频 ; 天 线 接头 : FC; 尺寸: 
115mmx80mmx20mm; 电源 : (DC) 12V; 重量 : 150g。 

全 套 设 备 包含 : 无 线 发 射 器 、 无 线 接收 机 、 音 视频 线 、 信 号 线 、 天 线 。 

(4) 视频 采集 卡 的 选 型 ”这 里 所 ”的 图 像 采 和 集 卡 是 指 将 已 生成 的 模拟 图 像 信 号 转换 成 数 
字 网 像 信 号 输入 计算 机 的 设备 。 无 线 摄 像 头 基本 上 都 是 模拟 信号 ， 通 利用 电视 线 进 行 连接 ， 
调制 模式 基本 上 是 调频 形式 ， 这 样 为 了 便于 在 PC 机 上 进行 观察 ， 所 以 需要 对 采集 的 模拟 信号 
进行 转换 ， 采 用 视频 采集 卡 对 其 进行 处 理 。 

采集 卡 分 为 硬件 压缩 型 和 软件 压缩 型 两 种 。 硬 件 压 缩 型 采集 卡 能 节约 系统 资源 ， 性 能 较 
为 稳定 ， 但 价格 较 高 :软件 压 纵 型 采集 卡 占用 较 多 系统 资源 ， 但 价格 便宜 。 考 夸 到 控制 病因 
受 体积 和 操作 方便 性 等 要 求 的 影响 ， 系统 资源 有 限 ， 并 且 以 后 会 需要 对 机 器 进行 图 像 处 理 功 
能 的 进一步 开发 ， 因 此 采用 硬件 压缩 型 卡 。 选 用 的 视频 采集 卡 如 网 1-18 所 示 ， 性 能 参数 见 
表 1-3。 


几 
al 
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图 1-17 无 线 收 发 模块 图 1-18 海 康 威 视 DS-4004HC 视频 采集 卡 
表 1-3 海 康 威 视 DS-4004HC 性 能 参数 
视频 压缩 标准 H.264 (MPEG-4/part10) 
视频 输入 路 数 4 路 
视频 输入 接口 BNC ( 电 平 1.0Vp-p， 阻 抗 75Q) 
文 持 制式 PAL、NTSC 
预 。 分辨 京 4CIF 
回放 分 辨 率 QCIF/CIF/2CIF/DCIF/4CIF 
帧 率 1/16~25 F/S (PAL) 
输出 码 率 32~1024kbit/s (CIF), 70~4096kbit/s (4CIF) 
音频 压缩 标准 OggVorbis 
音频 输入 路 数 4 路 ， 单 声 道 
音频 输入 接口 BNC ( 电 平 : 2Vp-p， 阻 抗 : 1kQ， 音 量 探 制 范 围 83dB ) 
采样 率 16kHz 
和 输出 码 率 16kB/s 
功 耗 每 个 DSP1.9W 


2. 图 像 处 理 基础 

图 像 经 过 采样 ， 模 拟 图 像 已 在 时 间 、 空 间 上 离散 化 为 像素 。 但 采样 结果 所 得 像素 的 值 仍 
是 连续 量 。 把 采样 后 所 得 的 这 些 连续 量 表示 的 像素 值 离散 化 为 整数 值 的 操作 称 为 量化 。 告 连 
续 值 用 z 来 表示 , 则 对 于 满足 zj 志 z 夺 zj+1 的 z 值 都 量化 为 整数 值 qi gq; 称 为 像素 的 灰 度 值 。 
z 与 qi 的 差 称 为 量化 误差 。 一 般 每 个 像素 的 灰 度 值 量化 后 用 一 个 字 广 来 表示 。 把 由 日 到 灰 到 黑 
的 连续 变化 的 灰 度 值 ， 量 化 为 0 一 255 共 256 个 灰 度 级 。 量 化 后 的 灰 度 值 ， 代 表 了 相应 的 ， 度 
程度 。 灰 度 值 与 ” 程度 的 关系 有 两 种 表示 方法 ， 一 种 是 由 0 一 25$ 对 应 于 由 黑 到 白 ， 男 一 种 
是 由 0 一 255 对 应 于 由 上 白 到 黑 。 对 只 有 黑白 二 值 的 二 值 图 像 ， 一 般 用 0 表示 白 ， 用 1 表示 黑 。 

一 幅 图 像 在 采样 时 行 、 列 的 采样 点 数 与 量化 时 ， 每 个 像素 量化 的 级 数 既 影响 到 数字 图 像 的 
质量 ， 也 影响 到 该 数字 图 像 数 据 量 的 大 小 。 量 化 级 数 一 定时 ， 采样 点 数 不 同 对 图 像 质 量 有 影响 : 
当 每 行 的 采样 点 数 减 少时 ， 图 像 上 的 块 状 效应 束 逐 渐 明 显 。 人 了 眼 每 度 视 角 内 像素 点 对 越 少 ， 则 
图 像 上 的 块 状 效应 越 明 显 ， 随 图 像 量化 级 数 的 减少 ， 图 像 会 逐渐 失去 灰 度 平滑 变化 的 特点 。 原 
来 灰 度 平 请 变化 的 部 分 ， 由 于 量化 级 数 的 减少 而 使 灰 度 产生 较 大 的 兰 别 ， 导 致 图 上 出 现 假 轮 廓 。 
假 轮廓 随 量化 级 数 的 减少 而 越 来 越 明 显 ， 量 化 级 数 最 小 的 极端 情况 就 是 二 值 图 像 。 
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在 数 子 图 像 处 理 中 ， 灰 度 和 直方 图 是 最 简单 、 最 有 用 的 工具 。 可 以 说 ， 对 图 像 的 分 析 与 观察 
直到 形成 一 个 有 效 的 处 理 方法 ， 都 离 不 开 百 方 图。 灰 度 直方 图 是 灰 度 级 的 函数 ， 描 述 的 是 图 像 
中 该 灰 度 级 的 像素 的 个 数 ， 即 横 坐 标 表 示 灰 度 级 ， 纵 坐标 表示 图 像 中 该 灰 度 级 出 现 的 个 数 。 通 
过 修正 图 像 直方 图 进行 图 像 增强 是 一 种 有 效 的 图 像 增 强 方法 。 直 方 岁 修正 增强 撤 术 是 以 二 方向 
作为 变换 的 依据 ， 使 变换 后 的 图 像 下 方 图 成 为 期 望 的 形状 。 和 直方 图 均衡 化 也 称 为 直方 图 均匀 化 ， 
束 是 把 给 定 图 像 的 下 方 图 分 布 改变 成 均匀 分 布 的 直方 图 ， 它 是 一 种 第 用 的 灰 度 增强 算法 。 

莉 型 多 用 途 反 杷 防 芭 机 如 人 以 上 述 理论 基础 来 进行 相关 图 像 的 人 处理， 为 目标 识别 、 大 场景 
观测 等 作战 任务 服务 。 总 之 ， 机 右 人 为 完成 作战 任务 ， 配 备 了 了 上述 高 性 能 视觉 监测 疙 年， 使 机 
髓 人 的 各 项 性 能 有 了 大 幅度 的 提升 ， 为 今后 车 用 机 闫 人 多 路 视觉 监测 设备 的 研制 积累 了 经 验 。 


1.3.3 ” 铀 酸 动力 电池 组 拉 术 


1. 电源 系统 的 设计 任务 与 要 求 

电源 系统 作为 新 型 多 用 途 反 多 防暴 机 器 人 的 重要 组 成 部 分 ， 相 当 于 机 占 人 的 “动力 心 
”对 于 机 器 人 的 正常 运行 和 工作 起 着 基础 性 的 作用 。 一 个 高 效 的 电源 系统 不 但 可 以 节省 
供电 能 源 的 消耗 、 优 化 系统 配置 ， 降 低产 品 的 成 本 ,还 可 以 更 加 科学 地 提 融 机 器 人 系统 整体 
的 工作 运行 性 能 ， 拓 宽 系 统 工 作 的 时 间 和 空间 域 ， 使 其 适应 更 加 复杂 和 和 恶劣 的 环境 。 合 理 的 
电源 系统 设计 必须 符合 机 器 人 总 体系 统 的 性 能 要 求 ， 满 足 其 动力 驱动 系统 、 控 制 系统 等 等 多 
方面 的 供电 要 求 ， 并 在 此 基础 上 满足 供电 优化 组 合 设计 和 配置 ， 使 各 个 系统 有 序 、 人 合理 、 协 

调 地 工作 。 

狐 型 多 用 途 反 您 防 骏 机 器 人 主要 包括 履带 式 车 载 平台 系统 、 运 动 控 制 系统 、 机 器 人 视觉 
监测 系统 、 无 线 通 信和 系统 、 武 器 发 射 系统 以 及 人 机 交互 系统 。 各 个 系统 均 需 要 电源 供应 和 分 
配 。 运 动 控 制 系统 主要 由 两 台大 功率 无 刷 直流 电动 机 及 其 驱动 器 、 两 台 步 进 电动 机 及 其 驶 动 
器 、 机 堪 人 主 探 计算机、 减速 器 和 驱动 轮 构 成 ， 主 要 的 用 电 设 备 为 : 两 台 900W、150V 直流 
供电 的 伺服 电动 机 是 全 系统 电源 供电 的 主要 部 分 ， 为 强 电 高 讨 大 功率 供电 ; 两 台 步 进 电 动机 
及 其 驱动 器 需要 的 电流 较 大 (4A)， 电 压 (48V) 介 于 高 压 和 低压 之 间 ; 主 探 计算 机 主要 的 
用 电 设 备 为 控制 主板 ， 为 低压 直流 电源 12V 供电 。 视 党 监 测 系统 由 三 路 远 红 外 摄像 状 、 视 
频 采 集 卡 、 视 频 无 线 发 送 模块 和 视频 无 线 接收 模块 组 成 , 用 电 设 备 主 要 为 摄像 头 及 相对 应 的 
收发 模块 ， 用 电量 较 小 ， 为 直流 低压 电源 供电 。 无 线 通信 系统 由 无 线 网 桥 和 天 线 构成 ， 无 线 
网 桥 供 电 电 压 为 24V， 用 电量 较 小 。 武 器 发 射 系统 由 防 又 弹 发 射 匿 、 特 种 弹药 等 部 分 构成 ， 
用 电量 较 小 。 人 机 交互 系统 的 用 电 设 备 主要 为 操控 箱 主板 ， 用 电量 较 小 ， 且 由 于 机 器 人 远程 
遥控 的 特点 ， 操 作 人 员 可 选择 有 220V 交流 供电 的 场所 进行 操作 ， 因 此 可 采用 已 有 的 电源 模 
块 简化 设计 。 

根据 各 个 系统 实际 的 性 能 指标 和 相关 参数 ， 电 源 系 统 设计 需 满足 以 下 基本 要 求 : 

1) 满足 各 个 系统 押 需 的 用 电 要 求 ， 并 满足 整个 系统 的 工作 时 间 要 求 。 

2) 满足 交 、 直 流 供电 要 求 。 

3) 设计 双 电 源 供电 系统 。 电 源 分 为 使 用 电源 与 备用 电源 ， 当 使 用 电源 不 能 正常 工作 时 ， 
备用 电源 能 够 立刻 起 作用 。 

4) 电源 设计 尽量 安全 、 和 简单。 电池 要 易于 拆 闭 和 更 换 ， 确 保 在 最 短 的 时 间 内 更 换 电 源 ， 
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提高 作战 的 连续 性 ， 保 了 作战 任务 的 顺利 进行 。 

2. 电源 系统 的 整体 设计 思路 

电源 系统 的 设计 主要 分 为 电池 系统 设计 和 电源 电路 设计 两 部 分 。 

(1) 电池 系统 设计 ，” 电 凶 系 统 的 设计 ， 一 方面 瑚 要 寻找 一 种 合适 的 供电 电池 ， 既 能 够 满 
足 系统 供电 要 求 ， 又 能 你 证 系统 的 安全 性 ， 妃 一 方面 需要 根据 机 器 人 和 芋 载 空间 的 限制 合理 分 
布 电池 系统 ， 同 时 满足 电池 的 安全 性 和 稳定 性 要 求 。 电 凶 系统 的 设计 步骤 如 图 1-19 所 示 。 


电池 系统 供电 分 析 


各 种 电池 性 能 
优 缺 点 比较 


确定 工艺 性 排 布 方案 
图 1-19 电池 系统 的 设计 步 又 
(2) 电源 电路 设计 电源 电路 主要 包括 电源 控制 电路 (交流 、 朋 流 )、 电 池 充 放电 电路 等 。 
电源 控制 电路 的 设计 主要 针对 各 个 电源 设备 的 分 布 、 性 能 指标 和 用 电 要 求 ， 优 化 线路 的 同时 ， 
辣 顾 提 融 线 路 安全 性 。 电 源 电 路 的 设计 步 又 如 图 1-20 所 示 。 
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充 放 电 电路 交流 电 充 放 电 电 路 和 直流 
部 分 一 一 交流 市 电 部 分 电池 系统 
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控制 电路 直流 
部 分 一 一 电池 系统 


控制 电路 交流 电 


部 分 交流 市 电 





完善 电源 电路 
设计 图 


系统 仿真 ， 人 确定 
最 终 电 路 图 


图 1-20 ”电源 电路 的 设计 步骤 


3 能源 电池 的 选择 与 比较 

目前 我 国 车 载 电池 的 种 关 较 多 ， 有 靖 控 密封 式 铅 酸 ” 电 字 、 乌 有 委 电 池 、 钊 ”电池 、 锂 离 
子 电 池 、 聚 合 物 锂电 池 、 空气 电池 、， 料 电池 等 等 。 其 中 ， 销 酸 ”电池 的 价格 最 低 、 使 用 
量 最 大 。 通 过 对 各 种 电池 进行 分 析 对 比 ， 茹 顾 新 型 多 用 途 反 灵 ′ 防 又 机 需 人 对 于 电池 的 相关 要 
求 和 性 能 指标 ,选择 沈阳 松下 公司 生产 的 LC-X1224 型 铅 酸 阀 控 式 ”电池 , 它 采 用 11 片 极 板 ， 
急 期 容量 不 大 ， 但 是 寿命 相对 很 长 。 电 池 外 观 图 如 图 1-21 所 示 。 

根据 机 磊 人 各 部 分 的 用 电 要 求 ， 购 买 13 块 电池 ， 每 个 电池 的 容量 不 低 于 20Ah。 考 虑 到 
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理论 放电 与 实际 放电 的 误 兰 ， 选 择 20h 放电 率 为 24Ah 的 电池 。 电 池 特 性 见 表 1-4。 电 池 放 电 
性 能 民 好 ， 能 够 满足 电源 供应 的 基本 需要 。 














图 1-21 LC-X1224 型 馈 酸 阀 控 式 ” ”电池 外 观 图 


表 1-4 电池 特性 


12 个 月 后 64% 


20h 放电 率 24Ah 

10h 放电 率 22Ah 
容量 (25 人 

5h 放电 率 19Ah 

lh 放电 率 14Ah 
内 阻 完全 放电 〈2S'C ) 11mQ 


4. 电源 电路 设计 

机 器 人 各 部 分 的 供电 需求 见 表 1-5。 大 功 座 无 刷 直 流 电 动机 和 步 进 电动 机 对 于 电源 品质 要 
求 较 高 ， 应 考虑 洪 加 稳 压 装置 和 ” 靳 保护 电路 ， 主 板 供 电 要 求 输出 电压 要 平稳 ， 因 此 也 要 考 
展 添 加 稳 压 模块 。 另 外 ， 值 得 注意 的 是 机 器 人 电气 设备 应 注意 绝缘 保护 。 

表 1-5 机 器 人 各 部 分 的 供电 需求 

DC150V 2 路 大 功率 无 刷 直 流 电 动机 供电 

DC48V 2 路 发 射 句 云 台 步 进 电动 机 供电 

DC24V 2 路 无 线 网 桥 、 天 线 、 警 灯 供 电 

DC12V 7 路 3 个 摄像 凑 、3 个 无 线 发 送 模块 、 主 板 供电 

DC5V 3 路 主板 控制 信号 、 步 进 电 动机 豫 动 控制 信号 供电 

















(1) 设计 原则 与 要 求 

1) 双 电 源 供电 模式 车 载 平 台 系统 采用 拖 绕 供电 - ”电池 双 电源 供电 模式 ， 一 方面 为 了 方 
便 调 试 ， 另 一 方面 也 保证 了 即使 在 车 辆 电池 耗 尽 时 仍 可 以 继续 进行 工作 。 两 种 工作 方式 通 
过 车 体 后 部 的 “开关 进行 切换 。 机 器 人 所 用 的 电缆 是 四 忆 电 缆 ， 两 根 线 是 通过 外 置 稳 压 电 
源 获 得 的 150V 直流 ， 另 两 根 是 220V 交流 ， 为 机 动 平台 单 板 计算 机 的 AT 电源 供电 。 

2) 强 弱电 的 物理 隔离 : 能 源 动力 系统 中 ， 把 强 电 与 弱电 、 动 力 电 与 控制 电 在 物理 上 进行 
隔离 ， 从 而 防范 由 于 强 弱 混用 可 能 造成 的 风险 。 在 本 系统 中 ， 对 于 150V 大 功率 无 刷 直流 电动 
机 、48V 步 进 电动 机 、24V 无 线 网 桥 和 警 灯 的 供电 作为 高 压 路 ， 采 用 12 块 馈 酸 电池 上 串联 并 配 
合 相 关 DC/DC 芯片 进行 供电 。 而 对 于 其 余 的 12V 和 5V 的 供电 需求 ， 因 该 部 分 主要 是 对 于 主 
板 供电 ， 所 以 单独 使 用 一 块 铬 酸 电 池 配 合 相 关 DC/DC 转换 器 进行 供电 。 

3) 快捷 便利 的 电池 充 放电 转换 : 机 器 人 中 串联 有 12 块 电池 ， 对 电池 充电 一 个 需要 研究 
的 问题 。 需 要 设计 一 套 充 放电 转换 电路 以 快速 实现 电池 组 由 放电 到 充电 的 转换 。 经 过 测试 发 
现 ， 所 使 用 的 铅 酸 电池 在 12 块 串联 时 充电 时 间 长 达 13h， 而 且 存 在 充电 不 均匀 现象 。 为 了 解 
决 这 个 问题 ， 准 备 在 充电 时 将 12 块 电池 分 为 三 组 ， 每 组 4 块 同 时 进行 充电 ， 显 然 这 样 可 以 缩 
短 充电 时 间 ， 并 使 电池 电量 更 加 均匀 。 这 是 电源 充 放 电 电 路 的 设计 要 求 。 

4) 绝缘 与 保护 : 绝缘 包括 电池 组 的 绝缘 、 用 电 设 备 的 绝缘 ， 保 护 电 路 主要 集中 在 用 电器 
部 分 ， 主 要 作用 是 稳定 电路 中 电压 ， 滤 除 纹 波 。 

(2) 电源 系统 的 组 成 ”电源 系统 的 组 成 见 表 1-6。 


表 1-6 电源 系统 的 组 成 


































































































电气 器 件 数 备 注 
铅 酸 电池 铅 酸 电池 ， 每 块 容量 24Ah， 标 称 电压 12V 
DC/DC150V-48V 索 ”电子 公司 定做 ， 功 率 200W 
DC/DC48V-24V 讯 仿 片 ， 功 率 50W 


DCDC12V12V 索 ”电子 公司 定做 ， 功率 100W 


[WS [We 一 -一 -一 一 一 OS 
el 


DC/DC12V-5V 索 ”电子 公司 定做 ， 功 率 50W 

电容 稳 压 器 电容 使 用 1200 ME 的 电容 

双 刀 双 开关 耐 压 250V， 耐 流 35A， 用 于 拖 统 - ”电池 供电 方式 切换 
驱 刀 双 ” 开 关 耐 压 250V， 耐 流 35A， 用 于 电池 组 充 放电 切换 


(3) 电气 原理 图 

1) 强 电 电路 。 强 电 电路 包括 直流 130V、48V、24V 线路 的 设计 。 强 电 电 路 部 分 原理 图 如 
图 1-22 所 示 。 

GD 双 电 源 供 电 由 于 机 器 人 采用 拖 绕 -直流 双 供 电 模 式 ， 双 电源 切换 采用 一 个 双 刀 双 开 
天 〔 见 图 1-22 中 的 SW2)， 方 框 阐 住 的 部 分 是 在 机 器 人 外 的 交流 电 及 150V 直流 稳 压 电源 。 
BT1、BT2、BT3 是 150V 电池 组 , 通过 开关 SW2 可 以 方便 地 实现 两 种 动力 模式 的 切换 ， 中 间 
态 时 区 停 。 

@) 快速 充 放 电 切 换 : 通过 双 刀 双 ”开关 SW1 实现 ，150V 电池 组 被 分 为 三 组 ， 每 组 50V， 
分 别 为 BT1、BT2、BT3， 当 开关 切换 时 ， 可 以 实现 电池 组 的 串联 和 断 开 ， 从 而 实现 快速 充 放 
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电 。 电 池 组 串联 给 用 电器 供电 ， 上 断 开 时 连接 相应 的 充电 接口 ， 通 过 外 接 的 50V 充电 器 即 可 实 
现 充 电 。 

@) 用 电器 供电 : 150V 除了 直接 给 主 电动 机 进行 供电 外 , 一 路 接 在 DC/DC150V-48V 上 ( 模 
块 电源 1)， 输 出 48V 在 给 发 射 句 步 进 电动 机 供电 ， 还 有 一 路 接 入 DC/DC48V-24V 图 1-22 
中 的 模块 电源 2)， 输 出 的 24V 为 无 线 网 桥 供 电 。 






















充电 -放电 转换 开关 


模块 电源 1 


W2 
: > 300V 48V 
a es CO 


拖 缆 -蓄电池 转换 开关 DCDC 


这 里 是 车 体外 一 台 稳 压 电 源 ， 输 出 电压 150V De St 
， 
线 网 神殿 有 电 接 口 
2 GND GND 弘 


图 1-22 强 电 电路 部 分 原理 图 


2) 弱电 电路 。 弱 电 电 路 包括 直流 12V、5V 线路 的 设计 。 弱 电 电路 部 分 原理 图 如 图 1-23 
所 示 。 

Q 双 电 源 供电 : 双 电 源 切 换 采 用 一 个 双 刀 双 ”开关 ( 见 图 1-23 中 的 S4),， 方 框 圈 住 的 部 
分 是 在 车 体外 的 交流 电 ，P2 是 车 内 的 一 块 台式 计算 机 上 的 AT 电源 ， 输 出 12V。BT4 是 一 块 
各 酸 电池 ， 输 出 12V。 通 过 开关 S4 可 以 方便 地 实现 两 种 动力 模式 的 切换 ， 中 间 态 时 关 停 。 

@ 快速 充 放电 切换 : 通过 开关 S3 实现 快速 充 放 电 。 充 电 接 口 配 用 12V 充电 器 。 

@) 用 电器 供电 : 12V 输出 后 ， 经 过 一 个 DC/DC 12V-12V 的 稳 压 模块 (图 1-23 中 
DC/DC-12)， 输 出 电压 12V， 用 于 车 辆 上 的 主板 、3 个 摄像 天、3 个 无 线 模块 的 供电 。12V 再 
经 过 一 个 DC/DC 12V-5V (图 1-23 中 DC/DC-5)， 输 出 电压 5V 用 于 主板 供电 和 步 进 电 动机 了 驱 
动 供电 。 

由 绝缘 与 保护 : 本 部 分 保护 电路 主要 是 DC/DC 12V-12V 的 稳 压 模块 (图 1-23 中 
DC/DC-12), 这 个 稳 压 模块 主要 为 下 一 级 的 主板 供电 提供 一 个 稳定 的 电压 , 防止 电压 突然 变化 
对 于 主板 造成 的 损坏 。 当 电池 电量 显著 下 降 时 ， 该 稳 压 模块 可 以 在 一 定 程度 上 提供 一 个 可 以 
让 主板 继续 工作 的 环境 ， 使 之 不 因为 电压 过 低 而 挥 电 。 
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图 1-23 弱电 电路 部 分 原理 图 


1.3.4 ”控制 与 无 线 通信 技术 


1. 控制 系统 总 述 

在 该 项 目 研究 中 ， 有 以 下 几 个 控制 对 象 ; 车 载 系统 大 功率 无 刷 直流 电动 机 ;， 包 发 射 云 
台 两 和 目 由 度 旋 转 步 进 电动 机 ;， 指令 的 无 线 传输 。 

机 器 人 的 总 体 结构 分 为 作业 端 和 遥控 端 ， 其 原理 图 如 图 1-24 和 图 1-25 所 示 。 

在 作业 端 单 板 计算 机 选用 研 ”EC5-1711CLDNA 搭建 主 控 计算 机 系统 。 为 实现 机 动 平台 的 高 
效 运 动 ， 车 载 平台 运动 控制 系统 执行 元 件 采 用 美国 元 尔 麻 根 公司 的 高 性 能 AKM42J-ANCNR-00 
型 大 功率 无 刷 直 流 电动 机 ， 并 配备 以 色 列 的 CELLO-15/200R 型 直流 伺服 电动 机 高 性 能 驱动 
峰 。 发 射 吉 云 台 采用 低 成 本 、 探 制 方法 简易 的 大 转 矩 步 进 电动 机 。 为 保证 通信 传输 的 实时 性 
和 重 棒 性 , 无 线 通 信 涛 置 末 用 美国 Axelwave 局 域 网 专业 公司 生产 的 AX9000PE-30 无 线 网 桥 
及 XA-212 天 线 。 在 控制 软件 的 编程 中 ，MFC 对 界面 的 编程 方便 实用 , 符合 人 机 交互 的 方便 
性 原则 。 

机 器 人 由 操控 者 发 送 的 指令 进行 控制 ， 给 定 元 件 为 控制 终 问 的 操控 箱 ， 执 行 元 件 为 大 功 
率 无 刷 直流 电动 机 和 步 进 电动 机 ， 由 于 车 载 平 台 运 动 需要 较 高 的 控制 精度 ， 故 需 闭 环 控制 ， 
采用 集成 于 直流 伺服 电动 机 内 部 的 光电 编码 盘 作 测量 元 件 ， 反 馈 到 驱动 控制 器 ， 以 稳定 电动 
机 转速 。 鉴 于 防暴 弹 是 定点 发 射 、 区 域 攻击 ， 故 步 进 电动 机 控制 精度 要 求 不 高 ， 采 用 开 环 控 
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制 ， 依 据 程 序 设 定 转速 即 可 。 控 制 对 象 为 车 载 平 台 系 统 和 防 桑 璋 及 射 明 ， 控 制 量 为 车 载 平台 
的 转 辐 及 行驶 速度 、 发 射 器 云 合 的 转动 方位 和 转动 速度 。 


驱动 轮 













视频 采集 卡 


佳能 。 两 






















用 摄像 头 

AKM 427— 
ANCNR-00 a ee 

型 电动 机 了 和 发 对 二 

CEL-15/200R 

ANCNR-00 和 三 发 射 器 云 台 

型 电动 机 驱动 器 驱 绚 名 步 进 电动 机 

发 射 器 
无 线 通 信 模 块 红外 摄像 头 


前 
无 线 通信 模块 红外 摄像 头 


图 1-24 机 右 人 作业 背 原理 疼 


遥控 手柄 及 
操控 面板 天 线 


视频 无 线 
接收 模块 大 线 


图 1-25 机 器 人 通 探 问 原 理 图 


机 避 人 的 上 位 机 和 下 位 机 均 为 单 板 机 ， 控 制 通信 接口 较 多 ， 且 安 疙 调试 方便 。 上 位 机 
接收 操控 者 由 遥控 手柄 和 操控 面板 发 送 的 指令 ， 经 无 线 通 信 系 统 将 指令 传送 给 下 位 机 ， 下 
位 机 根据 程序 代码 分 析 控 制 指 令 ， 人 确定 操控 者 要 求 机 器 人 完成 的 动作 ， 并 根据 程序 指令 纲 
动 两 合 大 功率 无 刷 百 流 电 动机 、 两 合 步 进 电动 机 、 大 场景 监测 摄像 头 云 侣 电动 机 进行 运动 ， 
实现 操作 者 的 操作 控制 。 视 频 图 像 显 示 采 用 无 线 视频 收 肥 模块 完成 ， 机 右 人 视觉 监测 系统 
通过 摄像 头 捕捉 战场 图 像 ， 并 将 图 像 通 过 视频 无 线 友 壕 模块 实时 传输 给 视频 无 线 接收 模 
块 ， 图 像 信息 经 上 位 机 人 处理， 由 液晶 屏 显 示 出 来 ， 实 时 监测 战场 环境 ， 为 操控 者 操控 机 融 
人 所 供 依据 。 

2. 控制 与 无 线 通 信 的 硬件 组 成 与 普 配 

C1) 作业 端 主 控 计算 机 ”机 左 人 运动 控制 系统 和 无 线 通 信 系 统 的 使 件 不 仅 需 要 满足 功能 
需求 ， 而 且 必 须 满足 高 性 能 、 低 功 耗 的 使 用 要 求 。 作 业 冰 主 探 计算机 是 车 载 平 全 控制 系统 的 
核心 部 分 ， 其 选 型 下 接 决 定 平 台 其 他 便 件 的 选择 。 

目前 ， 多 种 类 型 的 处 理 占 心 片 得 到 了 广泛 使 用 ， 例 如 早期 出 现 的 简单 的 单片机 、20 世纪 
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90 年 代 生 的 DSP、ARM 及 引领 了 CPU 发 展 趋 势 的 基于 x86 构架 的 Intel 处 理 器 。 由 于 机 器 
人 多 任务 、 多 功能 、 多 系统 的 特点 ， 需 要 大 量 的 接口 电路 、 功 能 扩展 插 槽 及 高 效 稳定 的 计算 
机 处 理 器 , 所 以 DSP、ARM 等 在 简单 鹏 入 式 设备 中 普 裔 使 用 的 处 理 占 并 不 适合 车 载 机 动 平台 。 
在 该 控制 系统 中 ， 作 业 端 主 控 计 算 机 选用 研 ”EC5-1711CLDNA 单 板 搭建 计算 机 系统 。 该 单 
板 机 的 性 价 比 较 蜗 ， 性 能 稳定 ， 且 功能 完备 ， 能 够 满足 机 器 人 多 任务 、 多 系统 的 控制 要 求 ， 
其 外 观 及 接线 图 如 图 1-26 所 示 。 











图 1-26 研 EC5-1711CLDNA 单 板 机 外 观 及 接线 图 


EC5-1711CLDNA 单 板 机 的 主要 参数 如 下 : 

1) 总 线 类 型 : $.25 ” 单 板 结构 。 

2) 处 理 器 : Pentium-M 和 Celoron-M 系列 低 功 耗 CPU。 

3) 系统 内 存 : 一 条 200- 针 DDR333 SODIMM， 支 持 最 大 1GB DDR RAM。 

4) 在 板 视频 : Intel 855GME 尺 片 整合 ， 文 持 CRT+LVDS 的 “ 双 显 示 ” 最 大 64MB 的 
动态 显示 内 存 共享 。 

5) 在 板 LAN: Intel 82562 100M 以 太 控 制 器 ，RJ-45 接口 。 

6) IDE 控制 器 : 一 个 40 针 ATA100 通道 ， 支 持 两 个 EIDE 设备 。 

7) 多 LO 接口 : 四 个 USB2.0 接口 、 一 个 并 口 、 四 个 RS-232、 一 个 PS/2 键盘 / ， 标 二 合 
一 接口 、 一 个 115Kbit/s IrDA 接口 ; 

8) 数字 IO: 4 路 数字 输入 ，4 路 数字 输出 。 

9) 扩展 总 线 : 一 个 124 针 Mini-PCI 扩展 总 线 、 一 个 标准 PCI 插 槽 扩展 。 

10) 电源 : 标准 20 针 ATX 电源 插座 和 4 针 AT 电源 接头 ，BIOS 可 自动 识别 电源 。 

11) 外 形 尺寸 : 203mmx146mm。 

(2) 伺服 电动 机 及 其 驱动 设备 ”电动 机 一 自分 直流 伺服 电动 机 和 交流 伺服 电动 机 ， 因 该 
机 器 人 要 实现 野外 作战 的 要 求 ， 必 须 采 用 直流 电池 组 供电 ， 因 此 需要 选用 直流 电动 机 ， 而 直 
流 电 动机 根据 不 同 特点 又 可 分 为 有 刷 直 流 电 动机 、 无 刷 直 流 电 动机 、 步 进 电 动机 和 骨 机 。 有 
刷 下 流 电 动机 和 无 刷 直 流 电 动机 的 性 能 对 比 见 表 1-7。 根 据 机 器 人 实际 作战 条 件 和 运行 状况 ， 
要 求 电 动机 有 较 大 功率 、 结 构 简 蛙 、 控 制 方便 ， 并且 有 和 较 高 的 可 徘 性 ， 不 允许 存在 火花 、 品 
声 等 问题 ， 综 合 比 较 各 种 直流 电动 机 的 优 缺 点 ， 选 用 无 刷 直 流 电 动机 。 
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表 1-7 有 刷 直 流 电动 机 和 无 刷 直 流 电 动机 的 性 能 对 比 














电动 机 类 型 缺点 
> 让 起 ， 请 优秀， 调和 速 3 定 ， Ss 口 人 
有 刷 直流 电动 机 a i 结构 复杂 ， 可 靠 性 差 ， 存 在 火花 、 噪 声 等 问题 
ee 保留 了 直流 电动 机 的 优点 ， 而 且 结构 简 | ”尺寸 较 有 刷 直 流 电 动机 大 ， 控 制 较为 复杂 ， 在 要 求 功率 
2 单 ， 运 行 可 靠 ， 维 护 方便 大 、 体 积 小 、 结 构 简 单 的 场合 ， 无 法 取代 有 刷 直 流 电动 机 





为 了 满足 机 器 僻 性 能 、 局 功率 的 要 求 及 严 ”环境 条 件 下 作战 任务 的 需要 ， 综 合 比 较 国 
内 外 大 功率 无 刷 直 流 电 动机 及 驱动 设备 的 性 能 特点 ， 选 用 美国 Kollmorgen 公司 的 
AKM42J-ANCNR-00 型 无 刷 直流 电动 机 并 搭配 以 色 列 Elmo 公司 的 CEL-15/200R 驱动 器 和 
ABR090-040-S2-P2 减速 器 ，ABR090-040-S2-P2 减速 器 的 减速 比 为 40:1。 美 国 Kollmorgen 的 
无 刷 直 流 电动 机 具有 良好 的 性 能 : 扭矩 /惯量 比 高 、 转 速 高 、 无 磨损 、 免 维护 、 刚 性 高 、 运 行 
平移、 位置 精度 高 、 调 速 范围 宽 、 动 态 特 性 好 。AKM42J-ANCNR-00 型 大 功率 无 刷 直流 电动 
机 如 图 1-27 所 示 ， 电 动机 主要 参数 见 表 1-8。 























图 1-27 AKM42J-ANCNR-00 型 大 功率 无 刷 直 流 电 动机 


表 1-8 AKM42J-ANCNR-00 型 电动 机 主要 参数 


额定 转 拓 连续 转 逢 堵 转 电流 
额定 转速 额定 功率 转子 惯量 重量 


CEL-15/200R 张 动 器 如 图 1-28 所 示 ， 了 驱动 器 主要 参数 见 表 1-9。 





图 1-28 ”CEL-15/200R 驱动 器 


mk 
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表 1-9 CEL-15/200R 驱动 器 主要 参数 


De Om 

从 数据 参数 可 知 ， 了 驱动器 的 峰值 电流 为 31.5A， 电 动机 的 堵 转 电流 为 33.7A， 因 此 在 机 器 
人 扑 坡 越 障 时 能 够 发 挥 电 动机 的 极限 动力 ， 使 动力 性 能 更 加 强 ”， 越 野 机 动能 力 更 加 完备 。 
此 外 ， 该 驱动 器 配 有 可 供 控制 人 员 开 发 用 的 API 函数 库 ， 调 用 简单 ， 控 制 方便 ， 很 适合 VC++ 
编程 。 

(3) 发 射 句 云 台 电动 机 及 其 张 动 设备 ” 因 发 射 器 质量 较 大 ， 故 需要 选用 大 扭矩 的 电动 机 ， 
但 对 电动 机 的 控制 精度 要 求 不 是 很 高 ， 小 于 等 于 1” 即 可 ， 且 对 运动 速度 的 要 求 较 低 ， 在 每 分 
钟 2 一 4 转 范 围 内 即 可 。 步 进 电动 机 一 般 用 在 中 低速 直接 驱动 的 定位 控制 场合 ， 而 且 具 有 无 累 
积 误 关 《精度 为 100%) 的 特点 。 伺 服 电动 机 一 般 用 在 高 速 、 高 动态 、 精 密 速 度 位 置 控 制 的 场 
合 。 对 于 同 场合 使 用 的 伺服 电动 机 系统 会 比 步 进 电 动机 系统 贯 2 一 $ 倍 的 价格 。 综 合成 本 、 探 
制 方案 的 简易 性 、 安 全 可 靠 性 及 实用 性 等 各 种 因素 ， 最 终 选用 步 进 电动 机 。 



































在 对 步 进 电动 机 进行 选 型 之 前 , 首先 计算 云 台 所 和 需 的 驱动 力 窍 , 计算 流程 图 如 图 1-29 所 示 。 


确定 驱动 机 械 六 管 部 件 尺 寸 、 准备 驱动 数据 图 
减速 比 、 外 作用 力 、 重 力 及 其 根据 定位 时 间 ， 确 定 加 减速 时 间 ， 





他 因素 起 动脉 冲 速 有 度 f!,， 最 大 脉冲 速度 f。 


计算 负载 力矩 7 
计算 负载 惯量 太 
暂时 选 定 电动 机 
-转子 惯量 不 小 于 负载 惯量 帮 的 1/10 


-在 起 动脉 冲 速 度 f1 时 ， 起 动力 矩 不 小 于 负载 力 窍 7 
-在 最 大 脉冲 速度 几时 ， 离 开 力矩 不 小 于 负载 力矩 侯 











计算 加 减速 力矩 亏 
根据 驱动 数据 图 ， 负 载 惯量 ， 转 子 惯量 等 因素 进行 
计算 





计算 驱动 力矩 妨 
-驱动 力矩 7 二 《加 速 力 矩 7 一 负载 力矩 7 ) 义 安 全 系数 
-在 最 大 脉冲 速度 时， 离开 力矩 不 小 于 驱动 力 算 








图 1-29 计算 步 进 电动 机 驱动 力矩 流程 图 
目前 比较 第 用 的 步 进 电动 机 包括 反应 式 步 进 电动 机 (VR)、 永 人 磁 式 步 进 电动 机 (PM)、 泥 
合式 步 进 电动 机 (HB， 和 单 相 式 步 进 电 动机 每 。 永 磁 式 步 进 电动 机 一 般 为 两 相 ， 转 答 和 体积 
较 小 ， 步 进 角 一 般 为 7.5” 或 15”; 反应 式 步 进 电动 机 一 般 为 三 相 ， 可 实现 大 转 矩 输出 ， 步 进 
角 一 般 为 1.5”， 但 噪声 和 振动 都 很 大 。 混 合式 步 进 电动 机 结合 了 永 磁 式 和 反应 式 的 优点 ， 应 
用 最 为 广泛 ， 故 选用 该 类 型 的 步 进 电动 机 。 经 市 场 调 研 ， 根 据 所 计算 出 的 驱动 力矩 ， 并 结合 
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电动 机 尺寸 和 可 供给 电流 ， 选 用 上 海 先 锋 工 控 有 限 公 司 生 产 的 87H7808 型 步 进 电动 机 ， 其 外 
观 如 图 1-30 所 示 。 

对 于 步 进 电动 机 驱动 器 的 选 型 ， 选 型 原则 非常 简单 ， 只 要 能 保证 满足 步 进 电动 机 的 使 用 
即 可 ， 细 分 越 大 越 好 ， 于 是 选择 了 一 个 60V、5A、8 细 分 的 驱动 器 。 选 择 的 驱动 器 为 上 海 先 锋 
工控 有 限 公 司 为 87H7808 型 号 步 进 电动 机 研制 和 生产 的 驱动 器 ， 其 外 观 如 网 1-31 所 示 。 该 驱 
动 器 的 输入 电压 为 DC20~40V， 相 电流 可 在 0.9~3A 之 间 调 节 ， 运 行 方式 包括 整 步 、1/2 步 、 
1/4 步 、1/8 步 、1/16 步 、1/32 步 和 1/64 步 ， 保 护 形 式 包括 过 热 保 护 、 锁 定 自 动 半 流 和 钳 接 保 
护 ， 外 形 尺 寸 为 11Smmx72mmx32mm， 重 量 小 于 300g。 





图 1-30 ”87H7808 型 步 进 电动 机 外 观 图 图 1-31 步 进 电 动机 驱动 器 

(4) 无 线 通 信和 系统 ”目前 的 无 线 通信 技术 按照 传输 距离 从 近 到 远 ， 依 次 有 鉴 ” 技 术 
(BlueTooth)、 红 外 通信 技术 、 无 线 局 域 网 技术 (WiFi) 及 专用 波段 的 无 线 电 技 术 等 〈 见 表 
1-10)。 监 ”技术 和 红外 技术 一 般 传 输 距 离 较 短 ， 带 宽 有 限 。 专 用 波段 的 无 线 电 通信 技术 可 以 
满足 长 距离 、 高 带宽 的 性 能 要 求 , 但 是 应 用 条 件 ” 刻 ， 使 用 成 本 高 是。 相 比 而 言 ， 采 用 2.4GHz 
公共 波段 的 WiFi 技术 比较 合适 ， 且 近年 来 WiFi 技术 获得 了 长 足 发 展 ， 带 宽 和 传输 距离 都 有 
了 显著 提高 ， 完 全 能 胜任 机 动 平台 作业 并 和 遂 探 端的 通信 和 需求 。 

表 1-10 几 种 无 线 通 信 技 术 的 比较 


六 IEEE 移动 电话 和 其 他 配件 间 进 


























无 线 局 域 网 1997 年 ”|IEEE 802.11 54 MB/s 25km 2.4GHz 和 5GHz 局 域 网 


专用 波段 的 本 广播 、 电 台 、 海 事 通信 、 


经 市 场 调研 ， 为 满足 机 器 人 无 线 通 信 过 程 中 的 实时 性 和 重 棒 性 ， 需 要 选用 稳定 可 靠 的 无 
线 通 信 设 备 。 参 考 网 络 资源 ， 可 知 Ax9000 系列 无 线 网 桥 能 窗 盖 大 围 的 无 线 网 络 ， 可 应 用 于 
户外 远 距 离 无 线 通 信和 大 面积 区 域 履 辣 ， 并 提供 最 高 达 108MB/s 的 带宽 ， 为 无 线 网 络 应 用 提 
供 了 可 靠 、 性 价 比 极 高 的 解决 方案 。 该 产品 采用 全 天 候 防水 、 防 侍 全 密封 设计 ， 拥 有 超 强 的 
免 维 护 特 性 ， 因 此 也 能 够 满足 机 器 人 恶劣 环境 作战 的 要 求 。Ax9000PE-30 无 线 网 桥 及 XA-212 
天 线 的 外 观 图 如 图 1-32 所 示 ， 有 具体 性 能 参数 分 别 见 表 1-11 和 表 1-12。 
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图 1-32 ”实际 安 闭 中 的 无 线 网 酉 和 天 线 
表 1-11 


Ax9000PE-30 无 线 网 桥 性 能 参数 


标 ” 准 IEEE 802.11b 
射频 类 型 直接 序列 扩 频 (DSSS) 
频段 2.4GHz 
诗作 模式 AP/AP Client/ 点 对 点 网 桥 /点 对 多 点 网 桥 
输出 功率 30dBm (max) 
传输 速率 11Mb/s/5.5Mb/s/2Mb/s/1Mb/s 自 适 应 
灵敏 度 -105dBm @11Mb/s 
频道 美国 /加 拿 大 : 11 信道 〈1 一 11); 
主要 欧洲 国家 : 13 信道 (1 一 13 ); 
10Base- 工 ，RJ-44 
oe 微波 : N 型 类 
安全 特性 最 高 可 达 128 位 WEP 加 密 ， 安 全 的 SSID; MAC 访问 控制 
软件 文 持 基于 SNMP 的 网 络 管理 工具 
工作 温度 : -15 一 605C 
4 -30 一 70'C ”湿度 : 5%~~95%， 无 冷凝 
外 形 尺 寸 210mmx135mmx 60mm 
重量 3.20kg 
电源 DC24V (POE) 
系统 文 持 Windows 98/Me/NT4.0 (SP4 及 以 上 版 本 ) /2000/XP 
表 1-12 XA-212 天 线性 能 参数 
频率 范围 2400~2483MHz 
市 宽 83MHz 
增益 12dBi 
最 大 功率 100W 
接头 型 号 N 座 
垂 直面 波 ”宽度 9° 
天 线 尺 寸 1.2m 
重量 1.2kg 
抗 风 强度 60nys 


(5) 机 器 人 操控 箱 设计 与 制作 ”机 霹 人 操控 箱 是 以 工控 机 主板 为 核心 控制 元 件 搭建 起 的 
用 户 终 闹 操 控 设 备 ， 为 了 实现 专用 化 ， 在 参考 普通 台式 机 组 北方 法 的 基础 上 ， 有 所 创新 。 

1) 计算 机 主板 : 选 型 方案 有 三 种 : 台式 机 主板 、 笔 记 本 电脑 主板 及 工控 机 主板 。 台 式 机 
主板 功能 丰富 ， 可 扩展 能 力 强 ， 价 格 便宜 ， 但 窜 出 特点 是 体积 大 ， 产 生 热量 多 ， 不 便于 做 成 
便携 式 操 控 箱 ， 夯 外 散热 方面 也 不 满足 要 求 ; 笔记 本 主板 体积 小 ， 但 可 扩展 能 力 不 强 ， 而 该 
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机 器 人 操控 需要 多 任务 、 多 系统 操作 ， 不 能 满足 性 能 要 求 ， 工控 机 主板 稳定 性 、 抗 干扰 性 能 
最 强 ， 适 合 在 恶劣 环境 下 作业 ， 符 合作 战 需 求 ， 且 功能 接口 较 多 ， 可 扩展 能 力 强 ， 具 有 其 他 
主板 无 法 比拟 的 优越 性 。 因 此 采用 工控 机 主板 作为 操控 端的 主 探 计算机 。 经 市 场 调研 ， 采 用 
威盛 工控 机 主板 ， 其 具体 功能 参数 如 下 : 

Q) CUP 主 频 : 1.5GHz。 

@) 内 存 搬 模 数量 : 2 个 DDR2 DIMM 内 存 插 槽 。 

(3) 显卡 接口 标准 : PCI Express。 

(4 便 盘 接口 标准 : SATA。 

G@) IDE 接口 数量 : 1 个 。 

(6) SATA 接口 数量 : 2 个 。 

G@) USB 接口 数量 : 6 个 USB2.0 接口 。 

@@ PCI 插 槽 : 1 个 PCI 插 槽 。 

PS/2 接口 : 1 个 PS/2” 标 接口 ，1 个 PS/2 键盘 接口 。 

d0 外 接 端口 : 1 个 并 行 接口 ，1 个 COM 接口 , 1 个 VGA 接口 ,1 个 RJ45 网 卡 接口 ,USB 
接口 ， 首 频 接口 。 

DD 电源 插口 :1 个 20 针 电 源 接口 。 

2) 主板 附属 配件 : 液 品 屏 采 用 北京 华 盛 万 中 科技 有 限 公 司 提供 的 12 ”笔记 本 液晶 屏 ， 
为 了 方 省 费用 ， 便 盘 、ATX 电源 模 块 、 散 热风 而 和 调试 程序 过 程 中 采用 的 键盘 标 均 采 用 记 
日 电脑 中 的 硬件 ， 经 组 装 调 试 ， 完 全 不 影响 使 用 。 操 探 面 板 采 用 四 通 游 杆 ， 经 键盘 映射 
机 制 ， 将 控制 指令 与 ” 杆 按 钮 一 一 对 应 ， 能 够 起 到 最 终 的 控制 效果 。 

3) 机 箱 : 机 箱 采 用 废旧 手提 箱 ， 主 板 及 附属 配件 经 安装 固定 ， 并 加 以 外 观 美化 ， 完 全 能 
够 实现 操作 功能 。 

3. 控制 与 无 线 通 信 的 软件 编程 

(1) 无 线 通信 编程 ”新 型 多 用 途 反 恐 防 其 机 器 人 的 上 、 下 位 机 之 间 的 通信 存在 两 个 特点 : 
频 索 的 数据 传输 和 恶劣 的 通信 条 件 。 可 以 通过 增加 通信 人 带宽 的 方法 来 提高 数据 传输 速率 ， 但 
是 在 人 硬件 上 无 法 解决 由 于 通信 的 瞬时 中 断 造 成 的 数据 丢失 问题 ， 所 以 在 软件 算法 上 提高 通信 
的 可 容错 性 尤为 必要 。 

Windows 系统 支持 的 TCP/PP 通信 协议 支持 UDP 和 TCP 两 种 通信 方式 , 其 中 TCP 通信 方 
式 由 于 存在 “应 答 返 回 ” 机 制 可 以 保证 数据 的 完整 传输 ， 理 论 上 不 存在 数据 丢失 情况 。 所 以 
采用 TCP 方式 作为 上 、 下 位 机 之 间 的 通信 可 容错 性 的 基础 。 

上 、 下 位 机 之 闻 的 通信 很 可 能 由 于 恶 作 的 通信 条 件 而 出 现 瞬时 挥 线 ， 而 一 般 的 TCP 通信 
方式 很 难处 理 这 种 异常 状态 ， 特 别 是 数据 传输 过 程 中 出 现 挥 线 的 情况 。 为 此 ， 创 建 以 下 一 套 
通信 机 制作 为 上 、 下 位 机 之 间 的 通信 可 容错 性 的 保证 :采用 多 线程 方式 实现 通信 ， 每 个 线程 
执行 一 个 单一 但 完整 的 信息 接收 或 发 送 任务 ， 经 历 从 套 接 字 创 建 到 套 接 字 关 闭 整 个 过 程 ， 线 
程 的 运行 过 程 相对 独立 ; 上 、 下 位 机 都 创建 两 种 类 型 的 线程 一 一 服务 器 闪 线 程 和 客户 端 线程 。 
服务 器 并 线程 创建 监听 套 接 学 ， 一旦 接收 到 一 个 信息 即 结束 该 线程 并 创建 男 一 个 具有 相同 功 
能 的 监 昕 线程 ， 保 证 在 任何 时 刻 系统 都 存在 一 个 监 昕 线程 以 接收 信息 ; 客户 六 线程 根据 需要 
而 创建 〈 同 一 时 刻 可 能 存在 多 个 )， 每 个 客户 端 线程 在 完成 信息 发 送 任务 后 即 结束 。 通 过 这 两 










































































第 1 章 ”新 型 多 用 途 反 恐 防暴 机 器 人 


种 闫 型 的 线程 ， 上 、 下 位 机 可 以 任意 互相 收发 信息 。 该 机 制 将 通信 过 程 中 “ 因 套 接 字 丢失 造 
成 信息 丢失 ”的 概率 大 大 降低 ， 并 且 使 程序 代码 的 复 用 性 可 以 在 两 详实 现 ， 减 少 了 程序 开发 
的 工作 量 。 上 、 下 位 机 之 间 的 一 次 信息 收发 的 流程 如 网 1-33 所 示 。 
服务 器 端 客户 端 
创建 监听 线程 创建 发 送 线程 


























调用 creat( ) 创 建 监听 调用 creat( ) 创 建 
Socket 一 个 会 话 Socket 
调用 bind( ) 捆 绑 监 听 
Socket 
调用 listen( ) 监 听 
连接 调用 connect( ) 连 接 
服务 器 
调用 accept( ) 接 受 
Socket 连 接 
调用 send( ) 发 送 
T= 信息 
调用 closesocket( ) 
关闭 Socket 
调用 closesocket( ) 关 闭 
Socket 
< 和 和 厨 结 束 程 
Y 
结束 进程 





图 1-33 上、 下 位 机 之 间 的 一 次 信息 收发 的 流程 

为 外 ， 在 通信 内 容 上 ， 机 如 人 还 有 一 套 目 建 通信 协议 ， 该 协议 以 一 个 四 位 数字 作为 消 轧 
头 ， 发 送 闹 在 发 六 消 朋 尖 后 根据 需要 友 迷 数据， 接收 问 在 接收 消 朋 类 后 确定 接收 后 续 数 据 或 
执行 消息 头 指 定 的 相应 任务 。 目 建 的 通信 协议 不 仅 发 挥 了 “高 层 指令 字典 ”的 作用 ， 还 因 简 
化 、 理 了 通信 和 内容， 成 为 所 融通 信 可 容错 性 的 重要 辅助 手段 。 

从 理论 上 来 说 ， 上 述 提高 通信 可 容错 性 的 方法 增加 了 通信 和 负 千 和 通信 延 时 。 计 算 表 明 ， 
任何 一 次 信息 收发 任务 所 传输 的 数据 量 不 超过 100KB， 而 通信 带宽 为 54Mb/s， 因 此 上 述 方 法 
几乎 不 会 造成 通信 延 时 。 根 据 测 算 ， 对 于 20KB 数据 从 发 送 到 应 答 一 般 耗 时 12ms， 可 见 ， 上 
述 方法 不 仅 能 大 大 提 融 通信 可 容错 性 ， 而 且 能 满足 通信 实时 性 的 要 来 。 

(2) 大 功率 无 刷 直 流 电动 机 控制 编程 cello 驱动 右 配 备 适 用 于 开发 人 员 编 程 使 用 的 API 
函数 亩 ， 方 便 项 目 开 及 人 员 调 用 。 当 客户 端 发 送 指令 请 求 时 ， 在 和 车载 平 台 主 控 计 算 机 的 服务 
名 痢 接 到 命令 进行 啊 应 ， 同 时 间 和 客户 器 发 送 应 谷 信 写 ， 告 知 命令 已 啊 应 。 在 服务 占 六 使 用 
switch/case 语句 ， 通 过 协议 代 担 分 析 判 断 肥 送 的 指令 请 求 ， 做 出 相应 的 啊 应 动作 。 在 运动 指令 
中 ， 比 较 重 要 的 儿 个 指令 函数 是 : 


1) AC Profiler acceleration limit, in counts/second2 
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2) BG Begin command 

3) BT Begin motion at defined time 

4) DC Deceleration, in counts per Second2 

5) IL Input logic, defining how dedicated inputs behave 

6) JV Speed ofjogging motion, in counts per second 

7) MO Motor on/off 

8) PA Absolute position reference for point-to-point motion 

9) PR Relative position reference for point-to-point motion 

10) SD Stop deceleration 

11) SF Smooth factor for motion command 

12) SP Speed for point-to-point motion 

13) ST Stop motion using deceleration value 

14) TC Torque command 

在 使 用 这 些 库 函 数 时 直接 在 程序 中 调用 即 可 。 以 控制 电动 机 起 动 为 例 ， 所 编辑 的 程序 代 
人 码 如 下 : 

vold motion: MoRun(WSABUEF buff) 


em Str; 

str.Format("%s",buff.buf); 

m pDriverl->SendCommand("BG",str); 

m pDriver2->SendCommand("BG",str); 

} 

(3) 步 进 电动 机 控制 并 口 编程 

1) 获得 张 动 器 所 需 的 控制 信号 。 目 前 ， 在 实验 室 和 工业 应 用 的 各 种 控制 系统 中 ， 串 口 是 
各 用 的 计算 机 与 外 部 控制 系统 之 间 的 数据 传输 通道 。 但 是 使 用 串 行 通信 ， 在 实时 性 、 速 度 、 
数据 量 等 方面 受到 限制 。 而 计算 机 的 并 行 站 口传 输 数据 时 是 一 次 性 传送 8 个 位 《一 个 字 节 ) 
或 更 多 ， 由 于 传输 量 较 大 ， 数 据 的 传输 速度 要 比 串口 快 ， 因 此 在 许多 必须 要 求 传 输 速 上 度 的 控 
制 系统 里 ， 用 PC 并 行 病 口 与 之 连接 是 一 个 很 好 的 解决 方案 。 

目前 ， 计 算 机 中 的 并 行 接口 主要 作为 打印 机 端口 ， 接 口 使 用 的 不 再 是 36 针 接 头 而 是 25 
针 DD 形 接头 。 常 见 的 并 行 接口 有 五 种 :SPP 型 、PS/2 型 、EPP 型 、ECP 型 和 多 模式 接口 。 大 
多 数 PC 机 配 有 SPP 并 口 。SPP 标准 并 行 接口 有 4 位 、8 位 、 半 8 位 ，4 位 口 一 次 只 能 输入 4 
位 数据 ， 但 可 以 输出 8 位 数据 ，8 位 口 可 以 一 次 输入 和 输出 8 位 数据 ， 半 8 位 也 可 以 。 

计算 机 的 标准 配备 并 行 接口 即 25 针 的 母 接头 接口 共有 
25 文 脚 ， 但 不 是 每 支 脚 均 被 使 用 到 。 这 些 脚 被 区 分 为 三 种 | 


主要 的 功能 ， 分 别 用 于 数据 的 传送 、 检 查 打印 机 的 状态 及 
控制 打印 机 ， 其 接口 如 图 1-34 所 示 。 


在 PC 机 中 ， 标 准 并 行 口 使 用 3 个 8 位 的 端口 寄存 器 ， 一 pe 
PC 就 是 通过 对 这 些 寄存 器 ， 也 就 是 所 说 的 数据 、 状 态 、 控 
制 寄存 器 的 读 写 访问 并 口 的 信号 的 。8 个 数据 位 分 别 为 D0~D7，5 个 状态 位 为 S3 一 S7，4 个 
控制 为 C0~C3， 其 中 字母 表示 了 端口 寄存 器 ， 数 字 则 表示 该 信号 在 寄存 占 中 的 位 。 
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2) PC 并 行 口 数字 输出 的 VC 实现 
中 数据 冰 口 数字 输出 的 VC 实现 : 
// 获 得 数据 新 口 地 址 : 
WORD m nport=(WORD)O0x378; 
/获得 要 写 入 数据 端口 的 值 WriteValue( 数 据 范 围 为 0 一 2593): 
DWORD m nValue=(DWORD)WriteValue; 
/调用 WinIo 库 函 数 SetPortVal 写 端口 值 
SetPortVal(m nport, m nValue, 1);//write a BYTE value to an L/O port 
G@) 控制 问 口 数 和 学 输出 的 VC 实现 : 
// 获 得 控制 端口 地 址 
WORD m nport=(WORD)O0x37A; 
// 获 得 控制 端口 的 值 ,保持 蜗 位 值 不 变 , 将 要 输出 的 值 从 低 4 位 输出 ， 且 使 连接 器 上 的 电位 状态 与 要 输出 的 














值 一 致 


DWORD temp dwPortVal; 

unsigned nt temp aa; 

GetPortVal(m nport, &temp dwPortVal, 1); /reads a BYTE value from an LO port 

temp aa=(unsigned Int)temp dwPortVal; 

temp_aa=temp_aa&0x0F0; // 取 低 8 位 值 ,将 低 4 位 置 为 0， 高 4 位 不 变 

temp_aa=temp aa^0x0B; /将 低 4 位 中 C0、C1、C3 置 为 1，C2 置 为 0; 高 4 位 不 变 

/获得 要 写 入 控制 端口 的 值 WriteValue( 数 据 范围 为 0 一 13): 

unsigned Int WriValue; 

WriValue 二 WriteValue&0x0F: // 取 低 4 位 

temp_aa=temp_aa^WriValue; // 将 写 入 值 的 低 4 位 中 的 C0、Cl1、C3 取 反 ，C2 位 不 变 ， 高 4 位 保持 端口 值 


不 变 








SetPortVal(m_nport, (DWORD)temp aa, 1); // 写 出 的 值 中 , 高 4 位 保持 端口 原来 的 值 不 变 , 低 4 位 写 入 么 


电 平 ， 连 接 器 上 就 是 么 电 平 


人 


(3) 数据 站 口 及 控制 端口 组 合成 12 位 数字 输出 的 VC 实现 
/获得 端口 地 址 : 
WORD m nportData=(WORD)0x378; 
WORD m nportControl=(WORD)0Ox37A; 
/获得 要 写 入 端口 的 值 WritevValue( 数 据 范 围 为 0 一 4095): 
DWORD m nValue=(DWORD)(WriteValue&0x0FF):;// 取 低 8 位 值 
SetPortVal(m nportData, m nValue, 1);//write a BYTE value to Data port 
DWORD temp dwPortVal; 
unsigned int temp aa; 
GetPortVal(m nportControl, &temp dwPortVal, 1); //reads a BYTE value from an LO port 
temp aa=(unsigned Int)temp dwPortVal; 
temp_aa=temp_aa&0x0F0; // 取 低 8 位 值 ,将 低 4 位 置 为 0， 高 4 位 不 变 
temp aa=temp aa^0x0B; // 将 低 4 位 中 C0、Cl、C3 置 为 1，C2 置 为 0; 高 4 位 不 变 
unsigned Int WriValue; 
WriValue 二 WriValue>>8:// 取 高 4 位 值 
temp aa-temp aa^WriValue; // 将 写 入 值 的 低 4 位 中 的 CO、C1、C3 取 反 ，C2 位 不 变 ， 高 4 位 保持 端口 值 不 变 。 
SetPortVal(m nportControl, (DWORD)temp aa, 1); // 写 出 的 值 中 , 高 4 位 保持 端口 原来 的 值 不 变 , 低 4 位 写 
么 电 平 ， 连 接 器 上 就 是 ”人 么 电 平 。 
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1.3.5 ”机 器 人 研发 实验 


1. 机 动 平 台 研 发 实验 

第 一 阶段 采用 计算 机 和 控制 手柄 远程 控制 机 动 平台 ， 同 时 实时 传输 图 像 。 所 做 实验 包括 机 
动 平 台 远 程控 制 实 验 、 实 时 图 像 传 输 实 验 、 高 速 行进 实验 、 草 地 行 强 实验 、 机 动 平台 有 效 载 答 
实验 、 欧 和 候 40” 和 僚 披 实验 、 翻 越 不 规则 阶梯 实验 和 越 障 实 验 ， 分 别 如 岁 1-35 一 图 1-42 所 未 。 










图 1-35 机动 平台 远程 控制 实验 图 1-36 ”实时 图 像 传输 实验 
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图 1-41 翻越 不 规则 阶梯 实验 





1-42” 越 障 实验 


2. 反恐 防暴 作业 平台 实验 

第 二 阶段 对 系统 进行 升级 ， 进 行 了 包括 发 射 锅 云 侣 、 视 觉 系 统 、 电 源 系 统 、 无 线 传输 系 
统 在 内 的 各 个 系统 调试 优化 。 所 做 实验 包括 发 射 右 云 侣 运转 实验 和 三 路 摄像 头 多 路 显示 效 琳 
实验 ， 实 验 情况 及 效 末 如 图 1-43 一 岁 1-48 所 示 。 
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1-44 ”光线 充足 ' 





请 况 下 三 路 摄像 头 多 路 显示 效 来 图 
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1-46 一 号 摄像 头 光 线 充 足 和 ” 视 环 境 条 件 下 拍摄 效果 实 
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图 1-47 二 号 摄像 头 光 线 充 足 和 视 环境 条 件 下 拍摄 效果 图 


- nls 下 
[a 二 |_ i 





1-48 三 号 摄像 头 光 线 充 足 和 ，” 视 环境 条 件 下 拍摄 效果 图 


到 四 主要 创新 点 及 取得 的 成 果 


1.4.1 作品 主要 创新 所 
作品 主要 创新 点 如 下 : 








1) 履 市 式 机 器 人 承重 轮 系 统 、 张 紧 轮 系统 目 适 应 特性 的 设计 与 实现 ， 可 你 证 机 器 人 在 复 











末路 面 情况 下 完成 蜗 难 度 运 动 ， 使 其 具备 了 局 效 的 越 障 能 力 ， 能 在 朵 民 路 面 下 快速 运动 。 

2) 取得 履带 陈 机 需 人 运动 性 能 突破 性 进展 ， 实 现 机 器 人 驱动 系统 、 传 动 系统 动力 参数 的 
匹配 与 协调 ， 可 保证 机 堪 人 在 大 功率 输出 条 件 下 稳定 可 靠 的 运行 。 

3) 实现 中 型 反 怒 防 眶 机 器 人 的 设计 与 制作 ， 极 大 提升 了 反 怒 防 歇 作业 机 姻 人 的 威 ” 力 与 








攻击 力 ， 与 德国 、 波 ”同类 产品 相 比 有 较 大 优势 。 


1.4.2 ”作品 取得 的 成 果 
作品 取得 的 成 果 如 下 : 





1) 新 型 多 用 途 反 芍 防 其 机 各 人 原理 样机 1 侣 。 

2) 痢 型 多 用 途 反 忍 防 又 机 器 人 研究 技术 报告 1 份 。 
3) 大 功率 二 流体 服 电 动机 的 控制 案 略 及 使 用 方法 。 
4) 远 距 离 无 线 通 信 系 统 的 构建 模式 及 技术 途径 。 














5) 大 场景 视觉 监测 系统 的 组 合 方法 及 调试 经 验 。 
6) 多 任务 实时 处 理 技 术 的 研究 成 来 及 应 用 技巧 。 
7) 蜗 电 压 、 大 功率 铅 酸 动力 电池 组 应 用 经 验 。 
8) 高 性 能 履 市 式 机 动 平 全 结构 造型 设计 经 验 。 
9) 多 功能 机 需 人 操控 箱 电 气 设计 与 制作 经 验 。 

















10) 获得 国家 友 明 专利 2 项 : 


中 轻型 履带 却 机 动 平 台 的 履带 目 动 张 紧 装 秆 。 





@) 轻型 履带 式 机 动 平 人 台 减 震 悬 挂 装 置 。 
11) 获奖 : 


QW 肯 届 全 国 大 学 生 创 新 论坛 “我 最 喜爱 的 10 件 作 品 ” 称 写 ， 排 名 第 一 。 
G@ 第 十 一 届 “ 挑 战 杯 ” 全 国 大 学 生 课 外 学 术科 拉 作 品 苋 完 一 等 交 。 


总 结 与 展望 
1.5.1 作品 研发 工作 总 结 
1. 完成 的 工作 








主要 完成 了 新 型 多 用 途 机 动 平台 整体 结构 的 设计 与 制造 和 用 于 反 芍 作业 的 反 私 防 骏 平台 


的 研制 与 集成 两 大 研究 任务 。 其 体 完成 情况 如 下 : 





(1) 机 动 平台 整体 结构 的 设计 与 制造 ”包括 机 动 平台 结构 体系 的 设计 与 仿真 ， 机 动 平 
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全 驱动 体系 的 设计 与 仿真 ;机 动 平台 传动 体系 的 设计 与 仿真 ;机 动 平台 运动 性 能 的 分 析 与 
仿真 ;机 动 平 台 动 力 性 能 的 分 析 与 仿真 ; 机动 平台 加 工 工 亏 的 分 析 与 仿真 ;机 载 微机 绽 合 
系统 的 构建 与 分 析 ; 机 载 无 线 通 信和 系统 的 构建 与 分 析 ; 机 载 视 觉 监 测 系统 的 构建 与 分 析 ; 
无 刷 下 流 伺服 电动 机 的 控制 与 调试 ， 电 动机 运动 特性 参数 的 匹配 与 调试 ， 配套 系统 相关 参 
数 的 融合 与 调试 。 

(2) 用 于 反 式 作业 的 反 愁 防 骏 平台 的 研制 与 集成 ”包括 防 骏 阐发 射 右 的 设计 、 造 型 、 
仿真 与 加 工 ， 防 暴 弹 发 射 云 台 体 系 的 设计 、 造 型 、 仿 真 与 加 工 ， 发 射 云 台 运 动 性 能 分 析 与 
仿真 ;发 射 云 侣 承重 分 析 与 实验 ; 发 射 云 台 与 能 源 动力 系统 、 控 制 系统 的 集成 与 调试 发 
射 句 用 上 脑 准 摄像 头 的 安装 、 固 定 与 系统 集成 ; 机 堪 人 专用 损 作 控制 箱 的 设计 制作 ， 防 又 弹 
模型 的 加 工 与 制作 ; 狐 型 多 用 途 反 鸭 防 暴 机 器 人 外 观 美化 与 装饰 ， 机 器 人 各 个 系统 集成 与 
协调 控制 。 

2. 经 验 总 结 

结合 本 作品 的 实际 情况 ， 总 结 学 生 读 外 科技 制作 中 带 有 规律 性 、 指 导 性 、 局 发 性 的 经 验 
和 体会 ， 得 到 如 下 一 些 经 验 与 结论 : 

1) 在 系统 研究 的 总 体 思 路 上 要 及 早 树 立 明 确 的 研究 目标 、 拟 定 合 理 的 研究 内 容 、 规 划 可 
行 的 应 用 背景 ， 这 样 才 能 使 项 目 上 共有” 强 的 生命 力 和 广阔 的 应 用 性 。 

2) 在 系统 研究 的 关键 技术 上 要 准确 定好 位 ， 选 择 那 些 一 旦 获得 突破 将 具有 创新 性 、 推 广 
性 、 实 用 性 的 技术 作为 项 目 攻关 的 核心 ， 展 开 富 有 成 效 的 研究 ， 可 取得 事半功倍 的 效果 。 

3) 在 系统 研究 的 科技 含量 上 要 尽量 做 到 高 起 点 、 局 标准 ， 使 项 目 研 究 成 果真 正 共 有 目 主 
知识 产权 和 推广 应 用 价值 。 

4) 在 能 源 动力 系统 设计 上 ， 本 系统 能 够 基本 满足 机 器 人 各 部 分 的 用 电 要 求 ， 能 够 较 稳 定 
地 提供 连续 的 动力 能 源 。 基 于 馈 酸 电池 及 相关 电器 元 件 的 稳定 性 ， 本 系统 能 够 具有 确实 的 安 
全 性 。 由 于 本 系统 可 采用 直流 电池 充电 和 交流 拖 绕 供电 两 种 方式 ， 因 此 电源 系统 在 充 、 放 电 
方面 具有 简捷 、 方 便 和 可 重复 利用 等 特点 。 

5) 项 目 团队 工作 是 人 否 有 效 也 是 项 目 成 功 的 关键 因素 。 据 科研 管理 有 关 部 门 统计 ， 一 个 项 
目的 成 败 往往 不 是 因为 技术 上 的 问题 ， 而 是 由 于 项 目的 管理 和 团队 建设 的 过 程 中 出 现 问题 ， 
导致 项 目 失败 。 在 完成 该 作品 的 过 程 中 ， 作 为 学 生 更 要 发 挥 团 结 协作 的 精神 ， 把 项 目 完成 好 ， 
达到 成 果实 现 和 有 上 所 收获 的 双重 目的 。 在 团队 建议 上 ， 可 总 结 如 下 经 验 : 

GD 明确 团队 成 员 的 研究 方向 、 目 标 和 任务 ， 同 时 为 每 个 人 明确 职责 和 角色 。 

@ 增加 项 目 团队 成 员 间 的 交流 ， 使 团队 有 北 聚 力 和 战 ” 力 。 

(3) 集中 安排 科研 时 间 和 地 点 ， 提 高 团队 的 整体 运作 能 

4) 由 指导 教师 和 实验 宇 的 学 长 对 团队 成 员 开 展业 务 塔 训 ， 提 高 团队 的 科研 技能 和 知识 
储备 。 

@) 培养 团队 的 精神 文化 ， 这 是 团队 有 效率 和 有 生命 力 的 根本 所 在 ， 和 群策群力 ， 发 挥 所 有 
人 的 智 意 和 力量 ， 使 每 个 团队 成 员 的 创造 力 得 以 充分 发 挥 ， 互 相 促 进 ， 彼 此 激励 ， 保 隧 沟 通 
流畅 ， 注 重 道德 品行 的 修炼 和 提高 。 

6) 注重 电气 接口 的 绝缘 处 理 ， 保 证 电路 连接 的 无 莽 钳 ， 坚 决 避免 短路 现象 和 火花 现象 
的 出 现 ， 把 工作 做 细 做 好 。 在 每 次 通电 前 要 检查 各 处 电路 情况 ， 用 电表 的 ” 鸣 器 挡 位 检查 
是 否 有 短路 现象 出 现 ， 并 对 元 件 设 备 接口 反复 检查 。 在 进行 电气 设备 实验 时 ， 遵 循 “ 少 时 、 

















































































































第 1 章 ”新 型 多 用 途 反 恐 防暴 机 器 人 


多 次 、 先 低压 、 后 高 压 、 循 序 渐进 、 功 能 蔡 换 ”的 原则 ， 确 你 实验 人 员 的 人 吴 安 全 和 设备 
安全 。 


1.5.2 ”作品 应 用 范围 及 前 景 分 析 


新 型 多 用 途 反 恐 防暴 机 器 人 可 用 于 反恐 作战 、 巡 赐 警 戒 、 驱 散人 和 群 、 野 外 环境 条 件 下 的 
作战 需求 。 未 来 碾 场 是 以 无 人 化 为 主 的 战场 ， 糯 国 对 阿 时 ”的 战争 使 得 无 人 机 和 机 需 人 的 使 
用 得 到 了 空前 发 展 。 

今天 ， 地 面 机 器 人 的 主要 任务 是 围绕 人 侦察、 监视、 扫雷 和 核 、 生 、 化 探测 ， 可 在 城区 、 
复杂 地 区 和 雷 区 等 很 多 场 区 使 用 。 机 和 右 人 丈 像 部 队 力量 的 倍增 右 一 样 ， 是 士兵 战场 上 的 防护 
设备 。 如 说 机 器 人 对 于 战场 士兵 在 执行 侦察 、 监 视 、 扫 雷 和 三 防 任务 中 ， 有 具有 ”置疑 的 
优点 ， 那 么 机 左 人 也 成 为 能 够 增 踢 部 队 火 力 的 倍增 亏 。 

狐 时 期 “以 人 为 本 ”的 理念 体现 在 社会 的 各 个 方 和 面 ， 对 于 军事 作战 随 看 无 人 化 的 需要 ， 
我 国 车 用 机 右 人 的 需要 量 也 会 增多 ， 如 果 新 型 多 用 途 反 恺 防 雄 机 器 人 安 站 GPS 全 球 卫 星 定 位 
系统 及 其 他 的 通信 设备 ， 可 用 于 组 建 机 器 人 车 团 ， 能 提高 我 车 的 战 ” 能 力 ， 减 少 人 员 伤 记 。 
在 安 你 中 也 可 使 用 该 机 器 人 进行 巡 亿 警戒 任务 ， 以 机 需 代 和 营 人 ， 不 但 可 以 降低 安保 费用 ， 而 
日 能 够 有 效 震 ” 骏 乱 分 子 ， 在 紧急 情况 下 实施 作战 任务 ， 确 傈 人 民生 命 财 产 安全 。 

在 当前 及 今后 的 反 加 、 反 等 各 项 ”和 争 中 ， 采 取 无 人 化 作战 方式 越 来 越 具 有 运 迫 性 和 
乍 要 性 ， 特 别 在 战区 、 雷 区 及 灵 怖 分 子 活动 区 往往 存在 大 量 的 危险 因素 ， 且 这 些 因素 不 多 
被 人 到 党 和 和 警 ”， 容 易 导 致 严重 后 末 。 痢 型 多 用 途 反 灵 ， 防 骏 机 器 人 由 于 其 出 色 的 运动 性 能 
和 方便 的 操 探 方式， 能够 出 入 这 些 人 危险 区 。 无 人 化 作战 机 器 人 有 看 广阔 的 市 场 前 景 ， 且 新 
型 多 用 途 反 邵 防 暴 机 器 人 的 成 本 相对 进口 反 灵 机 器 人 要 低 很 多 ， 从 价格 上 更 具有 强大 的 郭 
争 力 。 
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(第 二 届 全 国 大 学 生 创新 年 会 “我 最 喜爱 的 10 个 项 目 ,排名 第 三 ， 2009 年 ) 


随和 作品 研究 的 育 景 及 总 六 


搜救 机 器 人 是 将 机 械 设计 技术 、 智 能 控制 技术 、 传 感 探 测 拷 术 、 营 救 行 动 技术 和 灾难 学 
等 多 学 科 的 知识 有 机 地 融合 ， 是 当代 机 器 人 学 研究 中 一 个 富有 挑战 性 的 新 领域 。 新 型 搜救 机 
器 人 的 研制 成 功 将 极 大 地 提高 救援 的 效率 和 成 功率 ， 减 少 救援 过 程 中 不 必要 的 伤亡 ， 具 有 广 
冰 的 应 用 前 景 和 市 场 价 值 。 同 时 ， 研 发 搜救 机 器 人 所 涉及 的 设计 理念 、 关 键 技 术 、 实 验方 法 
对 相关 项 目的 研发 工作 也 具有 一 定 的 借鉴 意义 。 

1995 年 日 本 神户 ~- 大阪 的 大 地 震 及 其 之 后 发 生 在 美国 俄 元 拉 衙 马 州 的 阿尔 弗 德 联邦 大 楼 
焊 炸 案 揭 开 了 搜救 机 器 人 技术 研究 的 序 共 。 

2001 年 美国 9，11 事件 后 ， 美 国 机 器 人 辅助 救援 中 心 和 其 他 一 些 单位 的 救援 机 右 人 参与 
了 此 次 救援 行动 。 它 们 是 : Foster-Miller 公司 的 SOLEM 机 器 人 (图 2-1)、TOLON 机 器 人 (图 
2-2)。 机 器 人 在 此 次 救援 行动 中 取得 了 成 功 。 同 时 在 救援 中 也 其 露出 了 很 多 问题 ， 例 如 控制 
方式 不 可 靠 、 防 水 性 不 好 、 视 野 狭 罕 等 。 























图 2-1 SOLEM 机 器 人 图 2-2 TOLON 机 器 人 

加 拿 大 Inuktun 公司 设计 了 一 束 用 于 搜救 功能 的 履 市 式 变 结构 机 器 人 Micro-VGTV， 如 图 

2-3 所 示 。 设 计 者 在 机 器 上 闭 配 了 了 录像机、 侦 听 设备 和 热 感 应 设备 ， 可 以 友 现 生存 者 的 位 置 。 

Micro-VGTYV 形状 能 在 运行 期 间 改 变 。 当 在 它们 最 低 的 结构 形式 时 ,它们 相似 于 传统 的 履 市 陈 

搜救 机 器 人 。 当 它们 以 最 高 的 儿 何 结构 升 起 时 ， 外 形 就 像 一 个 三 角形 ， 仍 然 可 维持 看 整体 的 
平稳 和 坚固 。 
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图 2-3 ” Micro-VGTYV 机 器 人 变形 的 过 程 


日 本 三 蒙 重工 公司 研发 出 一 款 名 为 “灾难 助手 ”的 机 器 人 ， 如 图 2-4 所 示 。 这 款 机 器 人 
能 探测 出 毒性 气体 和 放射 性 物质 ， 还 能 够 从 废墟 中 寻 更 遇难 者 。 该 机 器 人 还 有 良好 的 自 平衡 





性 ， 可 以 攀 息 楼 梯 。 





图 2-4 “灾难 助手 ”机 器 人 
日 本 SGI 和 日 本 电气 通信 大 学 智能 机 械 工 程 系 松 墅 研究 室 于 2003 年 成 功 联合 开发 出 蛇 形 
救助 机 器 人 “KOHGA”， 如 图 2-5 所 示 。 这 种 蛇 形 机 右 人 为 8 节 车 体 相 连 的 蛇 形 设 计 ， 可 在 
央 灾 害 而 倒塌 的 建筑 物 中 四 处 移动 。 机 器 人 的 前 后 配备 有 CCD 相机 ， 可 监控 目 身 的 状态 ， 可 
通过 无 线 和 有 线 两 种 方式 操作 。 图 2-6 所 示 的 三 节 型 迪 形 搜救 机 堪 人 是 由 日 本 东京 技术 学 院 
研制 的 用 于 在 地 震 后 的 房屋 废墟 里 寻找 壮 存 者 的 机 器 人 ， 访 机 器 人 分 为 3 节 ， 用 6 个 履带 让 
行 ， 采 用 遥控 式 操作 。 
本， 二 
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el | 
图 2-5 ” 蛇 形 救助 机 器 人 “KOHGA” 图 2-6 三 节 型 蛇 形 搜救 机 器 人 


图 2-7 所 示 为 中 国 矿业 大 学 研发 的 矿难 搜救 机 器 人 。 这 亚 机 器 人 能 够 深入 事故 夏 井 控 测 ， 
并 实时 加 传 信 息 和 疼 像 ， 为 救灾 指挥 人 员 捉 供 重 要 的 现场 灾害 信息 。 同 时 ， 机 闫 人 还 能 携带 
和 急救 药品 、 人 食物、 生命 维持 液 和 人 简易 目 救 工具 ， 以 协助 被 图 人 员 实 施 目 救 和 逃生 。 





大 学 生 课 外 科技 创新 竞赛 获奖 作品 精 析 





图 2-7 矿难 搜救 机 右 人 
综 上 上 所 述 ， 世 界 各 国 已 经 意识 到 搜救 机 器 人 及 其 相关 技术 的 重要 性 ， 正 在 投入 大 量 的 人 














力 、 移 刀 和 财力 过 行 租 天 研 究 ， 部 分 产品 已 是 出 实 验 至 ， 缀 入 使 用 ， 但 从 使 用 效 末 来 看 ， 也 
存在 看 性 能 不 可 笔 、 通 信人 不 及 时 、 过 分 依赖 执行 人 员 操 作 等 缺点 。 国 内 对 搜救 机 喜人 的 研究 
步 较 晚 ， 主 要 集中 在 少数 高 校 和 科研 机 构 。 


组 和 作品 概述 


2.2.1 研究 内 容 概 述 


1， 机 器 人 系统 总 体 设计 

系统 总 体 设计 技术 是 新 型 特种 搜救 机 器 人 的 灵魂 ， 它 决定 着 整个 研究 工作 的 成 败 及 研究 
成 果 水 平 的 高 低 ， 其 核心 是 功能 与 结构 的 合理 组 合 、 性 能 与 效果 的 协调 统一 ， 由 此 才 会 引发 
新 型 特种 搜救 机 器 人 系统 设计 思想 、 研 究 方法 、 功 能 原理 、 结 构 特点 、 设 计 技巧 、 技 术 途 径 
及 测试 手段 等 的 全 面 创新 。 


2. 机 器 人 机 构 设计 

机 构 设计 是 新 型 搜救 机 器 人 研究 的 基础 ， 机 构 设计 的 
优 劣 直接 影响 到 机 器 人 的 灵活 性 和 机 动 性 。 机 器 人 设计 有 “”“ 
四 个 可 灵活 摆动 的 履带 臂 ， 机 身 完 全 被 行走 履带 包 窗 , 使 
得 机 器 人 在 通过 坎坷 崎 晓 地 面 时 行走 自如 ， 克 服 了 传统 履 > 
带 式 移动 机 器 人 由 于 底盘 与 地 面 做 仿 而 不 能 移动 的 缺点 ， 下 站 
提高 了 机 器 人 的 攀附 越 障 能 力 。 通 过 链 传动 及 电动 机 左右 四 一 司 ; 稻 
交错 布 放 的 方式 节省 了 有 限 的 机 体 空间 ， 行 走 履带 采用 阶 “证 Ne 人 
梯 状 齿 形 ， 使 得 机 器 人 可 以 在 不 同 质地 的 路 面 上 充分 发 挥 情 
其 机 动能 力 。 新 型 特种 搜救 机 妖 人 实物 样机 如 图 2-8 所 示 。 图 2-8 新 型 特种 搜救 机 器 

3. 运动 控制 技术 

针对 不 同 任务 和 作业 和 需要， 搜救 机 器 人 有 时 需要 高 速 推 进 以 快速 通过 危险 区 ， 有 时 需要 
车 疏 越 隐 ， 有 时 需要 低速 巡航 ， 因 而 必须 研究 其 在 不 同 作 业 环 境 中 的 运动 控制 技术 ， 包 插 多 
电动 机 协调 控制 技术 、 电 动机 功率 调节 技术 和 运动 方式 切换 技术 等 。 


















































第 2 章 ”新 型 特种 搜救 机 器 人 


为 使 狐 型 特种 搜救 机 需 人 体现 出 较 强 的 协作 性 ， 高 效 地 完成 任务 ， 采 用 基于 目标 任务 的 分 
层 递 阶 控制 体系 结构 作为 新 型 搜救 机 器 人 的 控制 体系 结构 ， 如 图 2-9 所 示 。 访 体系 结构 以 任务 
为 目标 ， 以 协调 合作 为 核心 ， 以 无 线 通 信 为 纽带 ， 主 要 包括 : 决策 层 、 通 信 层 、 协 调 层 和 执行 
层 。 决 策 层 使 机 器 人 系统 具有 一 定 程度 的 目 主 性 ， 可 将 外 部 环境 变化 或 操作 者 指令 所 引起 的 系 
统 内 部 啊 应 经 过 分 析 和 判断 ， 形 成 对 整个 机 堪 人 系统 的 控制 决策 ， 通 信 层 主要 负 贡 实施 实时 、 
局 效 、 无 差错 地 与 控制 中 心 进 行 通信 。 协 调 层 是 将 所 执行 任务 进行 分 解 ， 并 对 任务 执行 情况 进 
行 反 馈 。 执 行 层 通 过 驱动 各 个 执行 部 件 来 实现 机 右 人 的 运动 和 动作 ， 从 而 准确 融 效 地 完成 任务 。 
二 |。 关 莹 、 管 理 模块 [| 可 全 站 




























执行 反馈 


图 2-9 基于 目标 任务 的 分 层 逆 阶 控制 体系 结构 
4. 传 感 探测 与 通信 技术 
传 感 探测 与 通信 技术 是 新 型 特种 搜救 机 器 人 的 关键 技术 ， 准 确 地 探测 被 困 和 存 人 员 的 位 
置 并 将 周围 环境 信息 传送 给 营救 控制 指挥 中 心 丰 搜救 机 副 人 完成 协助 营救 任务 的 前 提 。 新 型 
特种 搜救 机 故人 拟 玉 用 可 见 光 /红外线 复合 探测 右 ， 即 使 在 照度 不 局 的 环境 中 也 能 清晰 地 米 集 


到 图 像 。 机 各 人 配 用 的 融 精 度 生命 探测 仪 用 于 确定 被 困 驻 存 人 员 的 位 置信 息 , 如 图 2-10 所 示 。 
上 述 信 息 通 过 无 线 网 桥 实时 地 传输 到 营救 控制 中 心 。 





执行 层 























生命 探测 仪 视觉 传 感 右 








图 2-10 ”装配 有 传感器 的 特种 搜救 机 器 人 
5. 能源 管 理 技术 
狐 型 特种 搜救 机 右 人 一 般 在 非 结 构 环 境 中 作业 ， 作 业 时 间 忆 成 为 衡量 系统 性 能 的 一 个 
重要 指标 。 结合 新 型 特种 搜救 机 器 人 系统 的 特点 ,对 能 产 管 理 技术 进行 研究 ， 可 降低 功 耗 ， 


在 系统 所 配 能 源 不 变 的 前 所 下 ， 极 大 限度 地 延长 作业 时 间 。 只 体 的 研究 细 下 将 在 2.3 小 市 
中 介绍 
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2.2.2 ”技术 指标 


1) 长 三 680mm， 宽 三 370mm， 高 三 220mm， 重 量 三 24kg， 有 效 载 答 为 10kg。 

2) 平均 巡航 速度 为 70m/min,， 最 大 巡航 速度 为 120m/min， 攀 越 障碍 高 度 0.4$Sm， 疏 坡度 45°。 

3) 可 根据 生命 探测 仪 输出 的 信息 判断 是 否 有 被 困 的 垂 存 人 员 ， 并 将 视觉 传感器 采集 的 周 
围 环境 信息 实时 地 传输 给 控制 中 心 ， 有 效 通信 距离 为 1.5km。 

4) 具有 防 侍 功能 ， 防 护 等 级 可 达 IP65。 

5) 持续 无 故障 作业 时 间 三 5h。 


天 键 近 术 


2.3.1 结构 造型 近 林 


1， 驱 动 结构 的 设计 及 功能 的 实现 

项 目 组 经 系统 研究 和 深入 探索 ， 设 计 了 一 种 能 够 在 师 虹 路 面 或 复杂 地 形 条 件 下 机 动 行驶 ， 
具有 较 高 机 动 性 和 较 强 越 隐 能 力 的 搜救 机 圳 人 驱动 朔 置 ， 目 的 是 在 你 证 机 器 人 只 有 局 机 动 性 
和 强 越 障 力 的 同时 ， 砚 服 传统 驱动 及 传动 系统 零件 众多 、 结 构 复 杂 、 效 率 低 下 的 缺点 ， 降 低 
系统 能 耗 ， 节 省 内 部 空间 ， 减 轻 整 体重 量 ， 提 高 机 器 人 的 工作 可 乱 性 和 行驶 称 定性 ， 为 搜救 
机 左 人 张 动 朔 置 提 供 新 的 设计 方案 和 新 的 技术 途径 。 

为 解决 上 述 技术 问题 ， 搜 救 机 器 人 采用 的 技术 方案 是 : 设计 搜救 机 融 人 张 动 装置 ， 包 括 箱 
体 、 云 右 对 称 布 置 的 行走 驱动 朔 置 、 摆 辟 张 动 装置 和 摆 辟 组件 。 其 中 行走 张 动 装置 位 于 箱 体 后 
部 ， 包 括 左 右 对 称 布 首 在 箱 体 两 侧 的 主动 轮 、 从 动 轮 、 行 走 履 市 。 主 动 轮 内 部 僚 有 行走 张 动 电 
动机 ， 行 走 驱 动 电动 机 在 驱 动 主 动 轮转 动 的 同时 起 到 主动 轮轴 的 作用 ;行走 驱动 电动 机 输出 珊 
插入 主动 轮 联 轴 此 中 ， 并 通过 紧 定 蝶 杀 和 键 带 动 联 轴 旧 转 动 ， 主 动 轮 联 轴 右 通过 键 连 接种 动 主 
动 轮 ， 主 动 轮 外 侧 设 有 弹性 挡 交 ;行走 张 动 电动 机 通过 桑 定 螺钉 癌 定 在 移动 上 座 中 ， 移 动 座 可 以 
在 箱 体 后 部 的 主动 轮轴 固定 座 中 前 后 移动 ， 从 而 调 记 主 动 轮 的 前 后 位 置 ， 起 到 张 紧 调 万 的 作用 。 
摆 辟 驱动 朔 置 包括 布置 在 从 动 轮 外 侧 同 轴 的 摆 殿 轮 ， 从 动 轮 通过 纪 轮 轴 周 回 对 称 布置 的 四 根 握 
臂 轮 同步 销 带动 摆 臂 轮 ， 保 证 摆 臂 轮 与 从 动 轮转 速 相同 ， 摆 避 轴 座 贯 军 从 动 轮 和 摆 臂 轮 中 心 ， 
并 且 通 过 虹 杀 固定 在 箱 体 侧 壁 上 ;， 摆 臂 轴 座 中 套 有 摆 臂 驶 动 电动 机 ， 电 动机 输出 轴 通 过 摆 辟 联 
轴 需 市 动 摆 臂 组 件 转动 。 摆 臂 履 市 组 件 包括 内 崩 、 外 避 、 摆 臂 张 系 组 件 ， 前 段 文 板 ， 摆 展 小 轮 
和 摆 辟 履 帘 ， 其 中 内 臂 套 接 在 从 动 轮 和 摆 展 轮 乙 间 ， 外 臂 转动 中 心 与 摆 避 轮 同 轴 ， 且 与 把 臂 联 
轴 喜 回 连 ， 摆 臂 张 紧 组 件 连 接 了 内 、 外 懂 及 前 段 文 板 ， 对 摆 辟 履带 起 张 紧 作 用 。 

行走 驱动 电动 机 输出 轴 的 外 站 面 与 主动 轮 外 侧 平 章 ， 最 大 限度 地 减少 了 行走 驱动 电动 机 在 箱 
体内 所 占 的 空间 ; 摆 臂 张 动 电动 机 完全 包含 在 摆 展 轴 座 中 ， 节 省 了 裤 间 ; 移动 座 通 过 与 移动 座 击 板 
问 接 形成 工 子 滑 块 , 进而 能 入 主动 轮轴 回 定 座 和 箱 体 侧 壁 形成 的 导轨 中 ; 主动 轮轴 国定 座 的 两 六 各 
有 一 根 紧 定 螺栓 ， 用 于 限定 移动 座 的 位 置 ， 进 而 限定 主动 轮 的 张 紧 位 置 ， 实 现 对 行走 履 市 的 张 紧 ; 
从 动 轮 和 摆 臂 轮 之 间 还 装 有 两 个 隅 奖 , 对 北 的 阳 团 固定 了 摊 恬 轴承 的 位 置 ; 摆 避 轮 同步 销 贯 穿 两 个 
隔 轿 ， 且 其 两 痪 分 别 插入 从 动 轮 和 摆 臂 轮 中 ;， 摆 臂 张 楷 组件 包 括 固定 在 内 避 和 外 臂 之 间 的 顶 汉 座 ， 
两 根 导 癌 轴 插 入 项 紧 座 中 ,滑动 座 插入 两 根 导 问 轴 中 ， 并 可 治 导 回 轴 移动 ， 清 动 座 通过 紧 定 螺钉 限 
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定 其 与 导 问 轴 的 相对 位 置 , 两 个 前 段 文 极 固 定 在 滑动 座 的 两 痪 , 摆 民 小 轮 安 装 在 前 段 文 板 的 最 前 端 。 

该 设计 的 优点 是 : 电动 机 作为 主动 轮轴 ， 对 主动 轮 起 a 到 支撑 、 定 位 和 驱动 的 多 重 作 用 ， 
简化 了 传动 机 构 ， 省 去 了 传统 传动 方式 中 的 轴承 件 ， 减 轻 了 驱动 装 蜀 的 重量 ， 此 外 ， 主 动 轮 
与 摆 辟 都 是 由 张 动 电动 机 直接 丝 动 ， 省 去 了 烦琐 的 传动 机 构 ， 最 大 限度 地 节省 了 宇 间 ， 降 低 
了 系统 故障 率 ， 为 移动 机 器 人 进一步 小 型 化 、 轻 量化 捉 供 了 解决 方案 。 

下 和 耐 结合 结构 图 对 本 设计 原理 做 进一步 说 明 。 

搜救 机 如 人 忆 体 结构 如 图 2-11 所 示 ， 访 机 各 人 是 一 种 小 型 六 履带 全 地 形 移 动机 帮 人 ， 
由 两 套 行 走 驱 动 装置 、 四 套 摆 臂 组 件 以 及 机 身 框架 组 成 。 机 堪 人 两 条 行走 履 帝 3.9 左右 对 称 
布置 ， 履 兰 了 机 需 人 机 身 框架 的 上 、 下 、 前 、 后 表面 ， 驱 动 电动 机 、 控 制 系统 及 动力 电源 都 
包含 在 被 行走 履 闪 3 复 焉 的 机 吴 框 架 内 ;两 套 行走 驳 动 多 置 位 于 摆 臂 驳 动 装置 13 和 摆 辟 张 
动 装置 12 的 内 侧 ; 机 右 人 前 后 器 各 安 浪 了 两 个 左右 对 称 布置 的 摊 恬 ， 摆 避 履 市 5.8 与 行走 
履带 3.9 的 线 速 度 相同 ， 在 翻越 障碍 时 ， 四 个 授 辟 可 以 起 到 支撑 、 攀 附 的 作用 ;， 机 各 人 上 部 
还 装 有 承载 平台 10， 可 用 于 安装 各 种 设备 附件 。 搜 救 机 需 人 行走 张 动 猴 置 分 解 图 如 网 2-12 
所 示 。 如 图 2-13、 图 2-14 所 示 ， 上 所 述 摆 展 驳 动 猴 置 、 或 摆 展 张 动 闻 置 、 或 摆 展 张 动 朔 置 、 
或 摆 辟 驱动 猴 置 ， 包 括 摆 臂 电动 机 、 摆 避 张 动 链 轮 16、 内 轴 套 14、 外 轴 套 17、 摆 臂 杆 13、 
摊 辟 小 轴 、 返 辟 小 链 轮 2、 提 医大 链 轮 1 以 及 硅 干 标准 件 ， 返 恬 大 链 轮 1 安装 在 摆 辟 杆 13 
前 端的 摊 辟 小 轴 18 上 ; 内 轴 套 14、 摆 展 驳 动 链 轮 16、 外 轴 套 17 和 把 臂 杆 13 依次 通过 螺栓 
串 接 固 连 在 一 起 ， 并 通过 轴承 套 接 在 主轴 6 上 ， 其 中 内 轴 套 14 穿 过 机 吴 侧 板 4， 两 者 之 间 
套 有 轴承 ， 这 样 可 以 保证 摆 辟 相对 于 主轴 6 和 机 号 侧 板 4 目 由 转动 ; 摆 臂 电动 机 15 固定 在 
机 号 侧 板 4 内 侧 ， 且 其 输出 轴 罕 过 侧 板 4， 摆 展 电 动机 15 通过 链 传动 带动 摆 避 张 动 链 轮 16 
转动 ， 从 而 市 动 摆 臂 杆 13 转动 ， 进 而 完成 机 器 人 摆 民 的 转动 ; 摆 避 小 链 轮 2 与 行走 链 轮 8 
外 径 相 同 ， 且 通过 键 连接 套 接 在 主轴 6 外 站， 与 主轴 6 同步 转动 ， 因 此 摆 展 小 链 轮 2 可 和 市 动 
摆 展 履带 5 与 行走 履带 3 保持 相同 的 线 速度 ; 摆 避 张 动 多 置 、 或 摆 避 张 动 装 症 、 或 摆 辟 驱动 
装置 、 或 摆 臂 驱动 冯 置 与 摆 民 履带 5 组 成 摊 辟 组 件 。 


















































图 2-11 搜救 机 磊 人 总 体 结构 


1 一 左前 捍 避 大 链 轮 2 一 左前 摆 避 小 链 轮 3 一 左 行走 履带 4 一 左 侧 板 “5 一 左 后 摆 臂 履带 
6 一 左 后 换 昼 驱动 装置 “7 一 右 后 摆 辟 驱动 装置 8- 右 后 摆 辟 履 带 “9 一 右 行走 履带 ”10 一 承载 平台 
1 一 右前 摆 辟 履带 “12 一 右前 摆 辟 驱动 装置 ”13 一 左前 摆 辟 驱动 装置 “14 一 左前 摆 辟 履带 
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图 2-12 ”搜救 机 右 人 行走 驱动 冯 置 分 解 图 图 2-13 ”搜救 机 器 人 摆 辟 、 行 走 驱 动 装 置 结构 
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2-15 ”搜救 机 费 人 内 部 结构 


图 2-13、 图 2-14 和 图 2-15 中 : 1 一 摆 臂 大 链 轮 ，2 一 摆 臂 小 链 轮 ，3 一 行走 履带 ;4 一 侧 
板 ; 5 一 摆 臂 履 珊 ; 6 一 主轴 ; 7 一 大 齿轮 ; 8 一 行走 链 轮 ， 9 一 基板 ; 10 一 行走 驱动 电动 机 ; 11 





一 行走 链 传动 系 ; 12 一 小 齿轮 ;13 一 捍 避 杆 ，14 一 内 轴 套 ; 15 一 捍 辟 电动 机 ;16 一 捍 恬 驱动 
链 轮 ;17 一 外 轴 套 ;18 一 摆 臂 小 轴 ，19 一 连接 板 ，20 一 履带 热 块 ，21 一 履 市 滚轮 ，22 一 小 轴 。 
2. 结构 造型 改进 方案 
为 了 降低 整个 搜救 机 器 人 的 重心 ， 改 善 其 稳定 性 ， 放 弃 原 来 将 总 控 平 侣 置 于 龙骨 上 方 的 
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莉 放 方案 ， 将 总 探 平 台 放 阐 于 搜救 机 器 人 帮 盘 上 ， 其 中 包括 视频 卡 、 风 忆 、 电 池 、 电 源 控制 
板 等 。 同 时 将 驱动 左 、 摄 像 头 、 超 声波 设备 等 都 置 于 履 珊 上 方 。 因 此 ， 吏 必须 设计 一 个 驱动 
控制 箱 。 要 求 能 安装 6 个 驱动 融 ， 方 便 检 修 ， 同 时 降低 局 上 度 。 

为 了 解决 这 个 问题 , 采用 了 将 一 个 铝板 直接 通过 5 个 螺钉 孔 回 定 在 龙骨 上 《龙骨 上 配 打 5 
个 孔 )， 同 时 为 了 加 强 连 接 强 度 ， 再 用 角 铝 做 成 角 撑 ， 加 强 龙 骨 和 铝板 之 间 的 强度 (图 2-16 
中 未 画 出 )。 为 外 ， 在 铝板 上 打 6 个 孔 ， 用 塑料 软 管 将 6 个 驱动 右 的 线 分 别 通过 这 6 个 筷 ， 从 
底盘 通 到 控制 箱 。 控 制 箱 示 意图 如 图 2-16 押 示 ， 张 动 右 是 通过 螺 多 二 接 固定 在 铝板 上 ， 便 于 
敢 热 ， 从 6 个 孔 里 伸 出 来 的 线 一 一 对 应 于 各 个 张 动 右 。 

为 方便 检修 ， 将 控制 箱 设计 成 可 拆 凶 式 。 上 新 板 如 图 2-17 所 示 ， 通 过 两 边 的 两 个 槽 ， 套 
扣 全 铝板 上 边 的 两 个 突起 。 铝 板 和 上 族 板 之 间 的 连接 可 通过 橡胶 绥 冲 执 ， 起 减 震 作用 。 为 了 
达到 更 好 的 通风 黎 热 的 效果 ， 将 铝板 的 左右 两 边 制 成 中 空 。 









































图 2-16 控制 箱 示 意图 图 2-17 箱 体 上 新 板 


为 了 使 抵 盘 能 为 安放 各 种 控制 卡 提 供 足 够 的 空间 ， 利 用 结构 上 调整 和 舍 放 组 状 控 制 卡 等 
方法 ， 将 压板 降 到 最 低 ， 将 各 种 控制 板 尽 可 能 集成 ， 从 而 能 够 更 多 的 控制 早 元 置 于 抵 盘 上 ， 
提升 机 桌 人 整体 性 能 。 

在 进一步 的 改 民 方 案 中 ， 将 对 机 右 人 现 有 传动 方式 进行 改进 。 目 前 的 机 堪 人 传动 方式 采用 的 
征 链 传动 ， 以 后 将 答 试 床 用 共有 传动 更 平 税 、 效 率 更 高 的 同步 珊 传 动 。 作 为 一 个 智能 履 融 式 机 噩 
人 ， 其 控制 必须 非 第 精确， 而 控制 的 精确 首先 必须 基于 仿真 结果 提供 的 数据 尽 可 能 准确 。 智 能 搜 
救 机 右 人 的 仿真 最 重要 的 是 履 市 参数 的 设 定 ， 包 括 阻尼 参数 和 刚度 系数 等 。 需 要 通过 仿真 得 到 的 
结果 包括 电动 机 的 输出 转 沧 和 转角 ， 知 能 搜救 机 右 人 的 越 障 能 力 、 转 守 能 力 、 加 速 性 等 。 


2.3.2 ”机 器 人 视觉 系统 


1. 机 器 人 视 品 系统 概述 

机 絮 人 视觉 系统 作为 机 器 人 系统 的 重要 环节 ， 将 为 机 右 人 目 主 控制 、 上 位 机 人 为 控制 提 
供 至 关 重 要 的 信息 。 机 器 人 视觉 系 统 通 过 视觉 传 感 右 获取 环境 的 二 维 图 像 ， 并 通过 视 党 处 理 
髓 进行 分 机 和 解释 ， 进 而 转换 为 符 亏 ， 让 机 磊 人 能 够 辨识 物体 ， 并 傅 定 其 位 置 。 在 该 机 器 人 
中 ， 视 觉 系 统 由 摄像 尖 和 超声 波 传 感 带 来 组 成 图 像 数 据 的 采集 疙 年 ， 通 过 Matlab 软件 完成 进 
一 步 的 图 像 处 理 与 算法 实现 ， 从 而 确定 前 方 障 碍 物 的 高 度 ， 搜 救 机 器 人 根据 视觉 系统 获取 的 
训 奶 将 目 动 判断 并 选择 翻越 还 是 采取 绕 行 的 方 双 。 

2. 超声 站 技术 

安全 避 障 是 移动 机 器 人 研究 中 的 一 个 基本 问题 ， 而 障 租 物 与 机 严 人 之 间距 离 的 获取 是 一 
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个 关键 环节 。 超 声波 在 空气 中 传播 时 ， 如 果 遇 到 其 他 媒介 ， 则 因 两 种 媒介 的 声 阻抗 不 同 而 产 
生 反 射 。 因 此 ， 向 前 方 路 面 障 碍 物 发 射 超声 波 ， 检 测 反射 波 并 进行 分 析 ， 便 可 判断 并 获知 前 
方 路 面 的 状况 。 

超声 波 传感器 以 其 信息 处 理 简 单 、 价 格 低廉 、 环 境 适 应 性 强 、 硬 件 实现 容易 、 近 距 范 围 
内 不 受 光线 影响 等 优点 ， 被 广泛 用 做 测 距 工 具 。 

3. 常用 超声 波 传感器 的 原理 及 其 结构 

在 目前 使 用 的 超声 波 传感器 中 , 按照 超声 波 产 
生 的 原理 主要 有 两 大 类 : 压 电 晶体 〈 电 致 伸缩 ) 类 
和 镍 铁 铝 合金 〈 磁 致 伸缩 ) 类 。 搜 救 机 器 人 中 使 用 和 [ 
的 是 前 一 种 超声 波 ,下面 对 压 电 晶体 制 成 的 超声 波 。” 革 CEELE、 























传感器 的 组 成 结构 及 其 产生 、 工作 原理 进行 简单 的 上 | 车 机 人 


介绍 。 超 声波 传感器 如 图 2-18 所 示 。 

超声 波 传 感 器 包括 三 个 部 分 : 超声 换 能 器 、 处 
理 单元 和 输出 极 。 

当 电 压 作 用 于 压 电 陶 次 时 , 就 会 随 电 压 和 频率 
的 变化 产生 机 械 变 形 。 男 一 方面 ， 当 振动 压 电 陶 效 图 2-18 起 声波 传感器 
时 ， 则 会 产生 一 个 电 奏 。 利 用 这 一 原理 ， 当 给 由 两 片 压 电 陶 次 或 一 厂 压 电 陶 将 和 一 个 金属 片 
构成 的 振动 右 ， 即 双 压 电 品 片 元 件 ， 施 加 一 个 电信 号 时 ， 婚 会 因 夫 曲 振 动 发 射出 超声 波 。 相 
反 ， 当 癌 双 压 电 唱片 元 件 施加 超声 振动 时 ， 束 会 产生 相应 的 电信 和 号 。 

首先 处 理 单元 对 超声 换 能 器 加 以 电压 激励 ， 其 受 激 后 以 脉冲 形式 发 出 超声 波 ， 接 独 超 声 
换 能 器 转 入 接收 状态 〈 相 当 于 一 个 麦克 风 )， 处 理 单元 对 接收 到 的 超声 波 脉 冲 进行 分 析 ， 判 断 
收 到 的 信号 是 不 是 所 发 出 的 超声 波 的 回声 。 如 果 是 ， 就 测量 超声 波 的 行程 时 间 ， 再 根据 测量 
的 时 间 计 算 量程 。 图 2-19 所 示 为 超声 波 测 距 原 理 图 。 
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图 2-19 ”超声 波 测 距 原理 图 


图 2-20 所 示 为 测 距 系统 整体 结构 图 。 训 距 系 统 使 件 结构 包括 上 位 机 、 处 理 右 、 超 声波 振 
滨 电 路 、 驱 动 电路 、 信 号 放大 电器、 整形 和 比较 电路 。 
超声 波 发 里 电路 由 振荡 电路 和 驱动 电路 两 部 分 组 成 。 振 荡 电 路 是 由 与 非 门 和 电阻 与 电容 组 成 
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的 简单 电路 ， 能 产生 40kHz 的 方 波 信号 张 动 超声 波 传感器 发 射 超 声波 ; 驱动 电路 产生 具有 一 定 功 
率 的 超声 波 电 脉冲 去 激励 超声 波 传感器， 由 6 个 非 门 并 联 组 成 ， 利 用 了 心 片 本 映 的 驱动 能 
刀 直 十 扯 砂 -- 多 
STC12C5410 超 疡 波 振 汇 电 路 下 上 > 下 
0 这 号 放大 电路 “|~| 换 | | 7 I( 
~ 
刀 击 池 折 沪 2 多 
STC12C5410 en 路 ul 
Ph 二 | 整形 、 比 较 电 路 
STC12C5410 
单片机 


信和 号 放大 电路 
整形 、 比 较 电路 上 
超声 波 接收 电路 分 信号 放大 、 整 形 和 比较 三 部 分 。 超 声波 接受 传感器 接收 的 信号 十 分 微 
弱 ， 仅 为 ” 伏 级 ， 充 信和 忆 需 要 经 过 放大 才能 被 单 请 机 检测 到 。 从 放大 器 输出 的 信号 经 过 倍 压 
整形 电路 后 进入 比较 器 。 调 节 比 较 絮 的 基准 电压 可 以 改变 测 距 系统 的 测量 冰 围 和 测量 精度 。 
超声 波 测 距 的 算法 一 般 采 用 渡 越 时 间 法 (time of flight，TOF)。 首 先 测 出 超声 波 从 发 
射 到 遇 到 隐 人 得 物 返 回 所 经 历 的 时 间 ， 再 乘 以 超声 波 的 速度 残 得 到 两 倍 的 声 源 与 障碍 物 之 间 
的 距离 ， 即 

































图 2-20” 测 距 系 统 整 体 结构 图 


























1 
而 二 (2-1) 
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式 中 , DD 为 传感器 与 被 测 障碍 物 之 间 的 距离 ;c 为 声波 在 介质 中 的 传输 速率 ， 在 空气 中 声 
波 传输 速率 为 c= cvV1+7/1273m/s ， 其 中 7 为 热力 学 温度 ，c,=331.4m/s 。 在 测 距 精 度 不 是 
很 高 的 情况 下 ， 一 般 认 为 c 为 340my/s 。 

由 式 (2-1) 可 以 看 出 ， 声 波 的 传播 速率 是 随 着 介质 温度 的 升 高 而 加 快 的 ， 气 温 增高 1C ， 
声速 增加 0.6m/s 。 表 2-1 列 出 了 波 速 与 温度 的 关系 : 











表 2-1 波 速 与 温度 的 关系 


温度 /"C 

波 速 / (m/s) 

系统 中 产生 的 误差 主要 来 日 于 温度 的 影响 及 超声 波 发 生 占 和 接收 莫 之 间距 离 而 导 伊 的 信 
写生 接 传 吉 。 

针对 温度 影响 ， 采 用 了 温度 传 感 占 进行 广 芝 人 补偿。 将 温度 传感器 的 温度 变化 值 转化 电压 
变化 值 ， 经 微 处 理 器 处 理 后 ， 计 算得 到 实际 的 流速 ， 从 而 消除 温度 对 超声 波 的 影 啊 。 

针对 超声 波 发 射 医 和 接收 右 之 间 信 和 号 直接 传递 的 处 理 ， 系 统 中 主要 采用 距离 修正 的 方法 
进行 修正 。 

考虑 友 射 和 接收 探头 之 间 的 距离 为 4g， 经 过 温度 补偿 后 的 实际 超声 波 波 速 为 c， 测 量 得 到 
的 时 间 值 TY?， 则 距离 公式 修正 为 
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4. 图 像 处 理 技术 

图 像 处 理 一 般 指数 字 图 像 处 理 。 数 字 图 像 是 指 用 数字 摄像 机 、 扫 描 仪 等 设备 经 过 采样 和 
数字 化 得 到 的 一 个 二 维 数组 ， 该 数组 的 元 素 称 为 像素 ， 其 值 为 一 整数 ， 称 为 灰 度 值 。 图 像 处 
理 技术 的 主要 内 容 包括 网 像 压 缩 ， 增 强 和 复原 ， 匹 配 、 摘 述 和 识别 三 个 部 分 。 研 究 方 向 从 图 
像 处 理 到 计算 机 视觉 可 以 分 为 三 个 层次 : 低级 、 图 像 预 处 理 、 增 强 处 理 ， 如 : 对 比 度 增 强 ， 
输入 、 输 出 均 为 图 像 ， 中 级 ， 网 像 分 割 ;， 高级， 模式 识别 。 输 入 为 岁 像 ， 输 出 为 规则 。 图 2-21 
为 图 像 处 理 系统 组 成 原理 网 。 

项 目 中 硬件 部 分 主要 为 摄像 头 、 图 像 接 收 和 发 射 装置 及 计算 机 。 软 件 部 分 主要 是 运用 
Matlab 软件 来 对 所 获取 的 数字 图 像 进行 处 理 。 图 2-22 所 示 为 视觉 系统 硬件 设备 。 
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图 2-21 图 像 处 理 系 统 组 成 原理 图 图 2-22 ”视觉 系统 人 硬件 设备 


S$.， 数字 图 像 处 理 的 一 般 步骤 

图 2-23 所 示 为 图 像 处 理 的 一 般 步 又 。 

数字 图 像 处 理 的 过 程 大 致 分 为 五 步 来 进行 : 

(1) 图 像 输入 ”图 像 处 理 的 第 一 步 是 获取 处 理 对 象 的 可 见 模拟 图 像 ， 并 将 其 转换 为 计算 机 
能 接受 的 数字 图 像 ， 再 输入 计算 机 。 如 果 对 象 的 信息 是 不 可 见 的 ， 则 首先 进行 所 谓 “ 信 息 的 可 
视 化 ”或 “可 见 光 图 像 生成 ”等 处 理 。Matlab 中 从 图 像 文 件 中 读 取 数 据 用 函数 imread0,， 这 个 函 
数 的 作用 就 是 将 图 像 文件 的 数据 读 入 年 阵 中 ， 此 外 还 可 以 用 imfinfo0 函 数 查 看 图 像 文 件 的 信息 。 
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图 2-23 ”图 像 处 理 的 一 般 步 怒 
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(2) 图 像 存 储 与 检索 ”为 了 你 存 、 处 理 或 者 传递 图 像 信 息 ， 需 要 将 原 图 像 或 经 过 处 理 的 
图 像 信息 在 计算 机 中 按 某 种 规律 存储 ， 必 要 时 可 以 查找 。 

(3) 图 像 增强 ”图像 增 强 是 一 种 将 输入 图 像 变 换 成 便于 获取 所 需 信 息 的 状态 的 各 种 处 理 
的 总 称 ， 也 可 理解 为 一 种 改善 图 像 品 质 的 处 理 内 容 。 例 如 噪声 〈 即 各 种 干扰 信号 ) 减弱 、 对 
比 度 改善 、 变 形 修 正 、 模 糊 消除 等 都 属于 图 像 增 强 的 内 容 。 由 于 种 种 原因 ， 图 像 的 品质 常常 
是 不 理想 的 ， 因 此 图 像 增 强 是 图 像 处 理 中 的 重要 环节 。 对 比 大 改 善 常 使 用 直方 图 均衡 化 的 方 
法 ， 灰 度 直 方 图 用 于 显示 图 像 的 灰 度 值 分 布 情况 ， 是 数字 图 像 处 理 中 最 简单 和 最 实用 的 工具 。 
Matlab 中 提供 了 专门 绘制 直方 图 的 函数 imnhist0，imadjustO 函 数 可 以 使 直方 图 均衡 化 。 对 于 如 
何 使 得 噪声 〈 即 各 种 干扰 信和 号) 减弱， 可 以 运用 代数 运算 ， 对 两 幅 输 入 图 像 进行 点 对 点 的 加 、 
减 、 乘 和 除 计 算 而 得 到 输出 图 像 的 运算 。 对 于 相 加 和 相 乘 的 情形 ， 可 能 不 止 有 两 幅 图 像 参加 
运算 。 图 像 相 加 的 一 个 重要 应 用 是 对 同一 场景 的 多 幅 岁 像 求 平均 值 。 这 点 被 经 各 用 来 有 效 地 
降低 加 性 随机 噪声 的 影响 。 男 外 ， 在 数字 图 像 处 理 中 ， 常 常会 过 到 图 像 中 混杂 有 许多 的 噪声 。 
因此 ， 在 进行 图 像 处 理 中 ， 有 时 要 先进 行 去除 噪 声 的 工作 。 最 党 用 的 去 除 噪声 的 方法 是 用 滤 
波 器 进行 滤波 处 理 。Matlab 的 图 像 处 理工 具 箱 里 设计 了 许多 的 滤波 器 可 供 选 用 。 

(4) 图 像 特征 提取 通过 图 像 信 息 去 测量 、 识 别 或 理解 其 中 的 对 象 物 ， 依 赖 于 一 些 能 
表征 对 象 物 的 图 像 特 征 ， 如 线 、 边 缘 、 区 域 、 形 状 、 颜 色 、 纹 理 等 等 。 通 过 各 种 处 理 方 法 ， 
将 包含 图 像 信息 中 的 必要 的 特征 显露 出 来 ， 并 加 以 量化 处 理 。 数 学 图 像 主要 是 二 值 图像 ， 
是 对 图 像 的 形状 特征 进行 提取 ， 形 状 特征 的 特点 : 各 种 基于 形状 特征 的 检索 方法 都 可 以 比 
较 有 效 地 利用 图 像 中 感 兴 趣 的 目标 来 进行 检索 ， 但 它们 也 有 一 些 共同 的 问题 ， 包 括 : 由 目 
前 基于 形状 的 检索 方法 还 缺乏 比较 完善 的 数学 模型 ， 书 如 果 目 标 有 变形 时 检索 结果 往往 不 
大 可 对 ;， 包 许多 形状 特征 仅 摘 述 了 目标 局 部 的 性 质 ， 要 全 面 摘 述 目标 第 对 计算 时 间 和 存储 
量 有 较 高 的 要 求 ; 由 许多 形状 特征 所 反映 的 目标 形状 信息 与 人 的 直观 感觉 不 完全 一 致 ， 或 
者 说 ， 特 征 空间 的 相似 性 与 人 视觉 系统 感受 到 的 相似 性 有 差别 。 另 外 ， 从 2D 图 像 中 表现 
的 3D 物体 实际 上 只 是 物体 在 空间 某 一 平面 的 投影 ， 从 2D 网 像 中 反映 出 来 的 形状 弟 不 是 
3D 物体 真实 的 形状 ， 由 于 视点 的 变化 ， 可 能 会 产生 各 种 失真 。 通 常情 况 下 ， 形 状 特征 有 
两 类 表示 方法 ， 一 类 是 轮廓 特征 ， 另 一 类 是 区 域 特 征 。 图 像 的 轮廓 特征 主要 针对 物体 的 边 
缘 ， 图 像 边 缘 对 图 像 识 别 和 计算 机 分 析 十 分 有 用 ， 边 缘 能 勺 男 出 目标 物体 ， 使 观察 者 一 目 
了 然 ; 边缘 含 了 丰富 的 内 在 信息 〈 如 方向 、 阶 跃 性 质 、 形 状 等 )， 是 图 像 识 别 中 重要 的 
图 像 特 征 之 一 。 从 本 质 上 说 ， 图 像 边缘 是 图 像 局 部 特性 不 连续 性 ( 灰 度 突变 、 颜 色 突 变 、 
纹理 结构 突变 等 ) 的 反映 ， 它 标志 看 一 个 区 域 的 终结 和 男 一 个 区 域 的 开始 。 而 图 像 的 区 域 
特征 则 关系 到 整个 形状 区 域 。 边 界 特征 法 通过 对 边界 特征 的 描述 来 获取 图 像 的 形状 参数 。 

Hough 变换 检测 平行 直线 方法 是 经 典 的 图 像 特征 提取 方法 。Hough 变换 是 利用 图 像 全 局 
特性 而 将 边缘 像素 连接 起 来 组 成 区 域 封闭 边界 的 一 种 方法 ， 其 基本 思想 是 点 - 线 的 对 偶 性 。 我 
们 先 看 这 样 一 个 问题 : 设 已 知 一 黑白 图 像 上 男 了 一 条 直线 ， 要 求 出 这 条 直线 所 在 的 位 置 。 直 
线 的 方程 可 以 用 Jec+p 来 表示 ， 其 中 和 4b 是 参数 ， 分 别 是 和 斜 深 和 截 距 。 过 某 一 点 (xo，yo) 
的 所 有 直线 的 参数 都 会 满足 方程 ypo=JKxrotb。 即 点 (xo，yo) 确定 了 一 族 直 线 。 方 程 yo=krxrotb 在 
参数 fb 平面 上 是 一 条 直线 ，( 也 可 以 是 方程 p=-xoktyo 对 应 的 直线 )。 这 样 ， 图 像 x-y 平 而 上 
的 一 个 前 景 像素 点 就 对 应 到 参数 平面 上 的 一 条 和 直线。 举 个 例子 说 明 解 决 前 面 那 个 问题 的 原理 。 
设 图 像 上 的 直线 是 y=x， 先 取 上 面 的 三 个 点 : 4 (0,，0),，B (1，1)，C (2，2)。 可 以 求 出 ， 
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过 4 点 的 直线 的 参数 要 满足 方程 b=0， 过 B 点 的 直线 的 参数 要 满足 方程 1=ktbp， 过 C 点 的 直 
线 的 参数 要 满足 方程 2=2k+bp， 这 三 个 方程 就 对 应 着 参数 平面 上 的 三 条 直线 ， 而 这 三 条 直线 会 
相交 于 一 点 (k=1，b=0)。 同 理 ， 原 图 像 上 直线 y=x 上 的 其 他 点 (如 (3，3),，(4，4) 等 ) 对 
应 参数 平面 上 的 直线 也 会 通过 点 (=1，5=0)。 这 个 性 质 就 为 解决 问题 提供 了 方法 : 首先 ， 初 
始 化 一 块 缓冲 区 ， 对 应 于 参数 平面 ， 将 其 所 有 数据 置 为 0。 对 于 网 像 上 每 一 前 景点 ， 求 出 参数 
平面 对 应 的 直线 ， 把 这 直线 上 的 所 有 点 的 值 都 加 1。 最 后 ， 找 到 参数 平面 上 最 大 点 的 位 置 ， 这 
个 位 置 就 是 原 图 像 上 直线 的 参数 。 上 述 即 为 Hough 变换 的 基本 思想 。 假 如 前 方 障碍 物 为 一 个 
圆 形 大 石头 ， 可 以 从 图 像 采 集中 得 到 一 副 半 径 已 知 的 圆 形 来 。 取 和 图像 平面 一 样 的 参数 平面 ， 
以 图 像 上 每 一 个 前 景点 为 圆心 ， 以 已 知 的 半径 在 参数 平面 上 画 圆 ， 并 把 结果 进行 累加 。 最 后 
找 出 参数 平面 上 的 峰值 点 ， 这 个 位 置 就 对 应 了 岁 像 上 的 圆心 。 在 这 个 问题 里 ， 岁 像 平 面 上 的 
每 一 点 对 应 到 参数 平面 上 的 一 个 圆 。 把 上 面 的 问题 改 一 下 ， 假 如 不 知道 半径 的 值 ， 而 要 找 出 
图 像 上 的 圆 来 。 这样, 一 个 办 法 是 把 参数 平面 扩大 称 为 三 维 空间 。 束 是 说 , 参数 容 间 变 为 x-y-R 
三 维 ， 对 应 加 的 圆心 和 半径 。 图 像 平 面 上 的 每 一 点 就 对 应 于 参数 空间 中 每 个 半径 下 的 一 个 圆 ， 
这 实际 上 是 一 个 圆锥 。 最 后 当然 还 是 找 参数 空间 中 的 峰值 点 。 不 过 ， 这 个 方法 显然 需要 大 量 
的 内 存 ， 运 行 速度 也 会 是 很 大 问题 。 有 另外 一 个 更 好 的 方法 ， 前 面 假定 的 图 像 都 是 黑白 图 像 
(二 值 图 像 )， 实 际 上 这 些 二 值 图 像 多 是 彩色 或 灰 度 图 像 通过 边缘 提取 来 的 。 前 和 面 提 人 到 过 ， 图 
像 边 缘 除 了 位 置信 息 ， 还 有 方 癌 信息 也 很 重要 ， 这 里 承 用 上 了 。 根 据 圆 的 性 质 ， 圆 的 半径 一 
定 在 垂直 于 圆 的 切线 的 直线 上 ， 也 束 是 说 ， 在 圆 上 任意 一 点 的 法 线 上 。 这 样 ， 解 决 上 面 的 问 
题 ， 仍 采用 二 维 的 参数 空间 ， 对 于 网 像 上 的 每 一 前 景点 ， 加 上 乞 的 方向 信息 ， 都 可 以 确定 出 
一 条 和 直线， 圆 的 圆心 就 在 这 条 直线 上 。 这 样 一 来 ， 问 题 束 会 简 蛙 了 许多 。 接 下 来 还 有 许多 类 
似 的 问题 ， 如 检测 出 椭圆 、 正 方形 、 长 方形 和 圆 弧 等 。 这 些 方法 大 都 类 似 ， 关 键 就 是 需要 熟 
悉 这 些 几 何 形状 的 数学 性 质 。 

(5) 图 像 输 出 “用 计算 机 再 现 输入 的 、 输 出 的 以 及 中 间 处 理 结 果 的 图 像 内 容 ， 是 我 们 考 
察 处 理 结果 、 获 取 人 处理 结果 所 必需 的 。 

6. 视 党 系统 总 结 

通过 超声 波 传感器 准确 测 得 机 器 人 与 障碍 物 的 距离 ， 通 过 摄像 头 采 集 得 到 数字 图 像 ， 并 
运用 Matlab 数学 图像 处 理工 具 箱 对 得 到 的 图 像 进 行 一 系列 的 处 理 ， 得 到 有 关 数 据 。 最 后 利用 
凸透镜 成 像 的 原理 ， 由 相似 三 角形 解 出 要 求 的 障碍 物 高 度 ， 将 数据 传输 给 计算 机 ， 由 它 来 决 
定 机 占 人 是 否 要 越过 障碍 物 。 


2.3.3 电源 系统 控制 近 木 


痢 型 特种 搜救 机 器 人 目标 定位 于 灾难 救援 ， 而 在 地 震 、 火 灾 等 灾难 现场 ， 该 机 需 人 的 长 
时 间 持 续 作 业 的 能 力 已 成 为 衡量 系统 性 能 的 一 个 重要 指标 。 结 合 新 型 特种 搜救 机 器 人 系统 野 
外 作业 的 特 点 ， 可 以 采取 以 下 两 种 技术 措施 来 提高 持续 作业 时 间 : (增加 机 右 人 的 电池 容量 ; 
包 降 低 机 天 人 的 能 量 消耗 。 昌 然 方法 中 简单 易 行 ， 但 是 由 于 机 右 人 的 体积 限制 ， 增 加 电池 必 
然 会 导致 机 器 人 重心 上 移 及 重量 增加 ， 运 动机 能 下 降 ， 对 于 在 灾难 现场 非 结构 环境 的 高 机 动 
性 要 求 来 六 很 不 利 。 而 通过 对 能 源 管理 技术 进行 研究 ， 降 低 功 耗 ， 达 到 在 系统 所 配 能 源 不 变 
的 前 提 下 极 大 限度 地 延长 作业 时 间 ， 成 为 最 终 研究 方 同 。 

根据 对 机 磊 人 电源 系统 的 研究 ， 采 用 动态 电源 党 理 超时 算法 对 所 设计 的 电源 管理 系统 进 
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行 控 制 。 通 过 对 整个 系统 进行 了 动态 建 模 与 数字 仿真 ， 并 通过 分 析 在 有 无 超时 算法 的 系统 消 
耗 ， 验 证 了 加 入 超时 算法 后 可 以 明显 降低 系统 的 功 耗 。 

1. 电源 系统 整体 框 染 

图 2-24 所 未 为 新 型 特种 搜救 机 帮 人 电源 系 
统 框 染 图 。 

狐 型 搜救 机 各 人 的 电源 系统 由 锂电 闻 组 、 
电源 定理 系统 和 用 电 设备 三 部 分 组 成 。 电 源 沁 
理 系统 在 电池 组 和 用 电 设 备 之 间 起 a 到 中 间 环 
万 的 作用 ,一 是 进行 升 压 和 降 压 使 输出 能 够 罗 
配 用 电 设 备 ; 二 是 通过 合理 设置 能 够 改善 系统 
整体 功 耗 水 平 。 

2， 动态 电源 管理 技术 研究 图 2-24 ”新 型 特种 搜救 机 费 人 电源 系统 框 淋 图 

动态 电源 管理 是 动态 地 分 配 系统 资源 ， 以 最 少 的 元 件 或 元 件 最 小 工作 量 的 低 耗 能 状态 ， 
来 完成 系统 任务 的 一 种 降低 功 耗 的 设计 方法 。 对 于 电源 管理 实施 时 间 的 判断 ， 要 用 到 多 种 预 
测 方法 ， 根 据 历 史 的 工作 量 预 测 即将 到 来 的 工作 量 ， 决 定 是 合 转 换 工 作 状态 和 何 时 转换 。 这 
就 是 动态 电源 管理 技术 的 核心 所 在 一 一 动态 电源 管理 方法 。 

动态 电源 定理 技术 适用 的 基本 前 提 是 ， 系 统 元 件 在 工作 时 间 内 有 春 个 相同 的 工作 量 。 大 
多 数 的 系统 部 具有 此 种 情况 。 为 一 个 前 提 是 ， 可 以 在 一 定 程度 上 确信 和 能够 预知 系统 、 元 件 的 
工作 量 的 波动 性 。 这 样 才 有 转换 耗 能 状态 的 可 能 ， 并 且 在 对 工作 量 的 观察 和 预知 的 时 间 内 ， 
系统 不 可 以 消耗 过 多 的 能 量 。 

最 普通 、 最 简单 的 动态 电源 过 理 方 式 是 关闭 系统 中 处 于 空闲 状态 的 组 件 ， 使 其 进入 节能 
状态 ， 但 将 系统 东 一 组 件 从 关闭 到 唤醒 会 有 时 间 上 的 一 定 延 迟 ， 并 且 在 此 过 程 中 还 会 产生 相 
应 的 能 量 消耗 ， 如 图 2-25 所 示 ， 所 以 只 有 当 用 电 设 备 在 关 团 时 所 节省 的 能 量 大 于 或 等 于 因 
状态 转换 所 额外 消耗 的 能 量 时 《〈 式 〈2-37))， 才 可 以 对 该 组 件 断 电 ， 否 则 不 宜 转 换 设备 的 供 


电 状 况 。 
工作 量 
十 3 


关闭 延 时 | EE 唤起 延 时 
能 量 


图 2-25 系统 组 件 由 开启 到 关闭 时 能 量变 化 示意 图 
A 宇 E+E, (2-3 ) 
式 中 ，Piae 为 系统 组 件 处 于 空闲 状态 时 的 能 耗 ， tae 为 系统 组 件 的 空 内 时 间 ; 玉 为 系统 组 
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件 由 衬 闲 状态 到 断 电 关闭 时 的 能 量 消 耗 ; 玉 为 系统 组 件 由 关闭 到 唤醒 时 的 能 量 消 耗 。 

由 于 对 大 多 数 真 实 系统 而 言 ， 即 将 输入 的 信和 号 往往 是 难以 确定 的 ， 所 以 动态 电源 管理 的 
决策 通 销 建立 在 对 未 来 空 亲 时间 的 不 确定 预知 的 基础 之 上 。 所 有 的 基于 预知 的 动态 电源 管理 
技术 的 基本 原理 是 探索 过 去 工作 量 的 历史 和 即将 发 生 的 工作 量 之 间 的 相互 关系 ， 来 对 未 来 事 
件 进行 可 靠 的 预知 。 这 种 预知 存在 厦 两 种 情况 : 一 为 预知 不 足 ， 即 预知 空 用 时 间 比 实际 空 亲 
时 间 短 ， 三 为 预知 过 上 度 ， 即 预知 空 朵 时间 比 实际 容 用 时 间 长 。 预 测 罕 用 时 间 不 足 将 不 能 达到 
节能 的 效果 ， 而 预知 过 度 又 将 造成 能 量 的 浪费 。 在 此 情况 下 ， 可 考虑 采用 固定 超时 法 来 妥善 
解决 上 述 问题 。 固 定 超 时 法 是 一 种 最 普 过 的 电源 管理 预知 法 ， 它 是 用 过 去 的 空闲 时 间作 为 观 
察 样 本 对 和 象 来 预知 当前 空闲 时 段 的 总 持续 时 间 。 访 方法 的 要 点 如 下 : 空闲 时 间 开 始 ， 计 时 器 
开始 计时 ， 超 过 固定 超时 时 间 tpg 而 系统 中 组 件 仍 处 于 空 亲 时 ， 则 电源 管理 系统 停止 对 该 系统 
组 件 供 电 ， 直 到 接收 到 外 界 供 电 请 求 ， 才 标志 看 空 用 状态 的 结束 。 采 用 这 种 方法 ， 系 统 市 能 
的 效果 主要 取决 于 tpE 的 选择 : 国定 超时 过 长 则 将 引起 预知 不 吓 ， 不 能 有 效 地 市 省 能 量 ， 相 当 
多 的 能 量 浪 费 在 等 等 超时 上 ， 在 机 器 人 搁 术 领域 ,通常 可取 tpe=tiqe。 国 定 超时 法 具有 简单、 
实用 的 特点 ， 而 且 系 统 组 件 可 能 的 空间 时 间 越 长 ， 应 用 这 种 算法 的 效果 就 越 好 ， 系 统 节 能 的 
幅 上 度 也 就 越 大 。 

3. 搜救 机 器 人 系统 布 能 设计 

新 型 特种 搜救 机 器 人 采用 多 种 传感器 ， 摄 像 头 和 六 个 电动 机 组 成 了 用 电 设 备 组 ， 这 些 
用 电 议 备 之 间 在 工作 对 象 、 工 作 机 理 、 工 作 特 性 和 工作 环境 等 方面 共有 很 强 的 互补 性 ， 因 
此 这 个 用 电 设 备 组 束 存 在 当 处 于 不 同 环境 中 只 有 部 分 组 件 有 效 工 作 执 行 任务 的 情况 ， 只 要 
能 合理 设计 各 用 电 议 备 的 工作 时 间 和 和 衬 闲 时间 ， 便 可 使 得 搜救 机 右 人 的 用 电 设 备 具 有 很 大 
的 节能 空间 。 表 2-2 为 搜救 机 器 人 系统 能 源 使 用 情况 一 “ 表 。 

表 2-2 搜救 机 器 人 系统 能 源 使 用 情况 一 览 表 

GPS 导航 室外 无 障碍 物 遮挡 区 域 测量 绝对 位 置信 息 

驱动 电动 机 平坦 地 形 和 非 结构 地 形 前 进 

反华 电动 机 | 4 | 9%0 | 非 结构 地 形 通过 摆 辟 电动 机 实现 和 坡 

生命 探测 仪 处 于 搜救 过 程 中 探测 生命 存在 


搜救 机 器 人 的 用 电 设备 中 ， 主 要 是 驱动 电动 机 需要 保持 时 刻 使 用 状态 ， 而 与 其 他 设备 构 
成 互补 。GPS 导航 由 于 其 能 耗 极 小 ， 可 不 纳入 电源 管理 的 范围 。 所 以 在 通 往 搜救 的 路 上 ， 其 
只 需要 驱动 电动 机 运动 就 可 以 ， 而 其 他 设备 就 可 以 采用 超时 算法 对 其 进行 控制 ， 实 现 节能 的 
效果 。 

4， 电 源 管理 系统 的 软 硬 件 设计 

经 过 上 述 分 析 ， 当 得 知 某 组 件 不 具备 工作 条 件 时 ， 通 过 设 定 的 超时 算法 进行 分 析 ， 若 达 
到 了 可 以 节省 能 量 的 阔 值 ， 就 关闭 该 组 件 ， 和 否则 电源 管理 系统 不 对 其 进行 断 电 处 理 。 对 应 的 
电源 管理 系统 硬件 构成 如 图 2-26 所 示 。 电 源 系统 管理 流程 图 如 图 2-27 所 示 。 在 该 管理 模块 


© 























































































































第 2 章 ”新 型 特种 搜救 机 器 人 





中 ， 可 以 通过 对 继电器 驱动 电路 写 1 或 号 0 控制 继 电 需 的 断 开 或 财 合 ， 这 残 使 传 感 左 系统 组 


件 实 现 了 按 需 关闭 和 唤醒 。 
断 电器 ”| |， 








PC104 总 线 


PC104 一 一 | 译 人 码 电路 


断 电 器 


图 2-26 电源 管理 系统 硬件 构成 


系统 组 件 处 于 空 闪 状态 


定时 器 开始 定时 (7) 


电源 管理 系统 继续 对 该 组 件 供 
电 组 件 消耗 一 定 的 能 量 


T<tie 时 


无 工作 请 求 有 工作 请 求 


电源 管理 系统 停止 对 该 组 
件 供电 ， 消 耗 EE. 









组 件 处 于 断 电 状态 ， 
不 消耗 能 量 


电源 管理 系统 对 该 组 
件 供电 ， 消 耗 羽 


组 件 处 于 工作 状态 


图 2-27 电源 系统 害 理 流程 图 





5. 电源 系统 电路 设计 

图 2-28 所 示 为 模块 电源 设计 的 电路 图 ， 输 入 电路 里 有 ”上 断 器 防止 电流 过 大 烧 ” 电源， 还 
有 稳 压 器 D1。 稳 压 和 小 小 电路 保证 了 电源 模块 本 喘 能 够 稳定 运行 。 同 时 考虑 到 因为 电动 机 的 
功率 很 大 ， 输 电线 路 上 的 压 降 也 必然 增 大 ， 故 采用 图 2-28 中 所 示 的 放射 性 接 法 ， 用 一 对 狂 寻 
线 将 电源 引出 ， 降 低 了 电路 的 压 降 ， 从 而 保证 了 电源 供电 的 稳定 和 效率 。 

图 2-29 所 示 为 12V 输入 用 电 设备 电路 图 。 
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图 2-29 12V 输入 用 电 设 备 电 路 图 
图 2-30 所 示 为 主 控 系 统 供电 图 ， 该 电路 主要 是 负责 给 超声 波 传感器 、 和 生命 探 测 仪 、 视 觉 
传感器 或 附加 设备 的 供电 ， 经 过 测试 能 够 满足 性 能 指标 。 

















| C4 (2 
1UEF |220HME 






图 2-30” 主 控 系 统 供电 图 


6， 电 源 系统 总 结 

针对 搜救 机 器 人 的 电源 管理 技术 ， 采 用 了 动态 电源 管理 技术 超时 算法 对 其 用 电 设备 组 进 
行 控制 ， 通 过 理论 的 研究 发 现 ， 超 时 算法 会 对 系统 节能 有 重要 的 ，” 献 ， 在 任何 复杂 环境 中 都 
能 长 时 间 稳定 作业 ， 体 现 出 了 优良 的 特性 ， 极 大 地 提高 了 搜救 机 器 人 整体 的 性 能 指标 ， 同 时 
体现 了 节能 环保 的 理念 。 


2.3.4 ”运动 控制 技术 


1. 控制 系统 综述 

针对 不 同 任务 和 作业 和 需要， 新 型 特种 搜救 机 各 人 有 时 需要 快速 通过 人 危险 区 ， 有 时 需要 获 
扑 越 阶 ， 有 时 需要 低速 巡航 ， 因 而 必须 研究 其 在 不 同 作业 环境 中 的 运动 控制 扩 术 ， 包 括 多 电 
动机 协调 控制 技术 、 电 动机 功率 调节 技术 、 运 动 方式 切换 等 技术 的 研究 。 
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为 使 新 型 特种 搜救 机 需 人 体现 出 较 强 的 协作 性 ， 能 够 高 效 完成 任务 ， 采 用 基于 目标 任务 
的 分 层 递 阶 控制 体系 结构 作为 新 型 搜救 机 规 人 的 控制 体系 结构 ， 如 网 2-31 所 示 。 该 体系 结构 
以 任务 为 目标 ， 以 协调 合作 为 核心 ， 以 无 线 通信 为 纽带 ， 主 要 包括 : 决策 层 、 通 信 层 、 协 调 
层 和 执行 层 。 决 策 层 使 机 器 人 系统 具有 一 定 程度 的 目 主 性 ， 可 将 外 部 环境 变化 或 操作 者 指令 
所 引起 的 系统 内 部 响应 经 过 分 析 和 判断 ， 形 成 对 整个 机 器 人 系统 的 控制 决策 ， 通 信和 层 主 要 负 
责 实 施 实 时 、 高 效 、 无 兰 错 地 与 控制 中 心 进行 通信 。 协 调 层 是 对 所 执行 任务 进行 分 解 ， 并 对 
任务 执行 情况 进行 反馈 。 执 行 层 通 过 驱动 各 个 执行 部 件 来 实现 机 器 人 的 运动 和 动作 ， 从 而 准 
傅 高 效 地 完成 任务 。 

























通信 层 

协调 层 
任务 评估 

执行 层 


行为 执行 模块 








图 2-31 基于 目标 任务 的 分 层 递 阶 控制 体系 结构 


控制 系统 各 个 部 分 有 其 独立 的 功能 ， 但 又 相互 协调 ， 相 互联 系 ， 在 总 线 的 控制 下 ， 有 机 地 
结合 成 一 个 整体 。 其 中 决 傈 层 起 看 中 枢 的 作用 ， 将 各 个 部 分 统一 调度 ， 共 同 完 成 搜救 机 右 人 的 
行为 动作 。 该 系统 由 无 线 通 信 模 块 、 视 频 采 和 集 模块 、 电 动机 驱动 模块 、PC104 控制 平台 及 远程 
PC 监控 平台 五 个 部 分 组 成 ， 如 图 2-32 所 示 。 上 位 机 负责 实现 人 机 交互 ， 实 时 显示 机 器 人 的 工 
作 状 态 及 其 环境 视频 信息 ， 并 根据 所 得 信息 按 一 定 算法 形成 运动 控制 指令 。 同 时 通过 民 好 的 用 
户 操作 界面 ， 用 户 可 以 实时 发 布控 制 指令 。 无 线 通 信和 模 世 负责 上 位 机 与 下 位 机 的 交流 通信 。 下 
位 机 一 方面 把 目 身 信息 传输 给 上 位 机 ， 为 一 方面 接收 上 位 机 的 指示 ， 加 以 解码 、 分 析 ， 并 结合 
相应 环境 ， 协 调控 制 各 驱动 右 工 作 ， 顺 利 完成 任务 。 下 位 机 的 摄像 尖 模 块 采 集 现场 的 图 像 ， 通 
过 无 线 局 域 网 传送 全 上 位 机 。 下 位 机 张 动 模块 完成 移动 机 器 人 的 运动 轨迹 控制 。 

2. 控制 系统 决策 层 

搜救 机 器 人 的 决策 层 采 用 目 主 与 半 目 主 相 结合 的 控制 方法 ， 可 根据 具体 的 环境 采取 不 同 的 
控制 方式 。 目 主 控制 是 指 机 堪 人 可 根据 采集 到 的 当前 环境 的 各 种 参数 来 合理 协调 本 身 的 动作 行 
为 ， 而 整个 过 程 不 需要 人 的 参与 。 半 月 主 控制 是 指 在 东 些 特殊 情况 下 ， 操 作者 通过 上 位 机 发 出 
站 令 来 控制 机 旨 人 ， 完 成 部 分 功能 的 控制 方式 ， 使 之 能 够 蝇 效 、 快 速 、 炊 确 地 执行 任务 。 决 集 
层 的 控制 是 通过 上 位 机 来 实现 的 ， 采 用 VC++ 编 程 的 方法 ， 通 过 MFC 建立 一 个 人 机 交互 界面 ， 
这 样 便于 操作 者 发 出 各 种 指令 参数 来 指导 机 右 人 的 行为 。 而 在 目 主 控制 中 ， 机 需 人 通过 视频 、 
声音 采集 等 方式 获取 到 当前 环境 的 各 种 参数 ， 传 送 给 上 位 机 。 上 位 机 可 将 外 部 环 蒂 变 化 所 引起 





















































大 学 生 课 外 科技 创新 竞赛 获奖 作品 精 析 


的 系统 内 部 啊 应 经 过 分 析 和 判断 ， 形 成 对 整个 机 需 人 系统 的 控制 决策 ， 再 来 控制 机 妖 人 的 运动 。 








环境 信息 


执行 级 
| | 协调 级 (PC104) i 决策 级 
i 码 盘 信 息 | (上 位 机 ) 
| | 
| | 
无 线 通 信 | 
/ / 
| 
控制 指令 
障 

碍 
物 
距 | 
岗 
| 

| 

一 天 超声 波 传感器 | 
| 

| 

| 

| 

| 

| 

| 

| 

| 


图 2-32 ”各 控制 层 的 具体 执行 框 网 


3. 控制 系统 通信 和 层 

在 设计 制作 搜救 机 器 人 控制 系统 的 过 程 中 ， 首 先 遇 到 的 问题 是 底层 网 络 的 选择 ， 在 工业 
控制 系统 中 , 现场 IO 设备 之 间 的 数据 传输 方式 主要 有 基于 RS-232c 总 线 通 信 、 基 于 RS-442A 
总 线 通信 、 基 于 RS-485 总 线 通信 及 基于 现场 总 线 通信 。 

RS-485 与 RS-232 总 线 技 术 存 在 缺陷 , 在 工业 、 企业 底层 网 络 中 应 用 现场 总 线 来 构建 开放 
式 、 数 衬 化 的 多 点 通信 已 成 为 必然 ， 由 相关 技术 资料 及 国内 外 现场 总 线 的 应 用 来 看 ， 在 撒 层 
网 络 中 应 用 比较 多 的 是 Profibus、Lonworks、CAN 这 几 种 现场 总 线 。 在 多 轴 运 动 控制 系统 中 ， 
通过 对 上 述 几 种 总 线 的 比较 ， 决 定 采用 CAN 总 线 技术 来 实现 控制 系统 通信 网 络 模 型 ， 主要 从 
下 面 儿 个 方面 进行 考虑 ; 首先 CAN 总 线 采 用 短 帧 结构 ,数据 传输 的 时 间 短 ,， 受 干扰 概率 低 ， 
并 且 CAN 有 民 好 的 检 错 措施 ， 可 靠 性 高 ， 避 免 了 人 花 型 数据 传输 过 程 中 出 现 一 位 或 多 位 数据 错 
误 ， 导 致 偶 关 ，CAN 协议 对 通信 数据 块 进行 编码 的 方法 ， 可 是 不 同 的 节点 同时 收 到 相同 的 数 
据 ， 可 以 实现 点 对 点 通信 ， 增 加 了 系统 组 网 的 灵活 性 ，CAN 采用 基于 优先 级 的 非 破 坏 性 位 
裁 方式 保证 了 系统 不 会 由 于 产生 总 线 墙 ” 而 产生 ” ”， 保 证 了 网 络 的 实时 性 和 可 徘 性 ， 书 男 
外 CAN 总 线 既 可 构成 单 主 网 络 又 可 构成 多 主 网 络 ， 任 何 节点 都 可 主动 向 网 上 发 送 数据 ， 通 信 
方式 十 分 灵活 ; G@) 其 次 是 从 便 件 及 软件 开销 上 考虑 ，Lonworks，Profibus 标准 的 通用 性 使 得 在 
采用 三 家 现成 的 设备 组 网 较为 方便 ， 但 通用 性 好 必然 导致 通信 协议 更 加 复杂 ， 系 统 软件 设计 
的 复杂 性 导致 软件 开销 的 增加 ，CAN 总 线 相 对 来 说 ,通信 协议 比较 简单 ， 开 发 技术 比较 成 熟 ， 
软件 工作 量 小 而 容易 实现 ， 性 能 上 也 未 必 比 其 他 儿 种 现场 总 线 兰 。 则 最 后 从 可 靠 性 的 角度 考 
碟 ， 在 整个 系统 的 运行 过 程 中 ， 不 希望 由 于 茶 个 节点 的 故障 而 导致 整个 系统 的 次 痪 ， 在 和 点 
回复 后 能 上 自动 连 上 ， 因 此 任何 节点 的 损坏 都 不 会 导致 整个 系统 的 通信  ， 综 合 所 述 ，CAN 
总 线 是 最 适合 多 轴 运 动 控制 系统 的 底数 据 通 信和 方式 。 
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在 搜救 机 器 人 中 ， 一 共用 到 六 个 电动 机 ， 用 CAN 总 线 与 六 个 电动 机 的 张 动 右 连接 ， 将 之 





设置 为 节点 ， 这 样 节省 了 串口 的 个 数 ， 使 通信 更 为 蝇 效 和 市 省 空间 和 导线 。CAN 总 线 的 运动 


上 位 计算 机 
a 





体系 控制 原理 图 如 图 2-33 所 示 。 


供 入 陈 运 动 


本 
控制 器 CAN BUS 双 绞 线 
| 





CAN 接 口 CAN 接 口 
驱动 器 驱动 器 
伺服 电动 机 伺服 电动 机 


图 2-33 ”CAN 总 线 的 运动 体系 控制 原理 网 

在 项 目 初始 阶段 , 搜救 机 器 人 的 运动 控制 主要 由 操作 者 控制 完成 , 操作 者 由 PC 发 出 指令 ， 
指令 通过 通信 接口 传输 至 下 位 机 ， 由 CAN 总 线 统筹 负责 信号 的 传递 ， 控 制 驱动 需 完 成 运动 。 

随 独 运动 数据 的 不 断 丰 宇 ， 操 作者 将 越 来 越 少 地 参与 搜救 机 器 人 的 运动 过 程控 制 ， 大 部 
分 动作 将 由 下 位 机 目 动 操 作 控 制 完成 ， 有 共 体 的 实现 步骤 是 : 通过 视频 采集 部 分 发 送 回 的 图 像 ， 
操作 者 控制 搜救 机 器 人 的 下 一 步 动 作 ， 扑 坡 、 越 障 或 是 继续 直线 行走 。 扑 坡 时 ， 下 位 机 会 根 
据 指 令 控制 摆 臂 电动 机 旋转 ， 传 感 器 会 及 时 传 回 摆 臂 电动 机 与 地 面 接触 处 的 压力 变化 值 ， 传 
至 下 位 机 ， 下 位 机 会 从 以 往 摆 臂 的 压力 变化 数据 库 中 ， 与 这 时 传 回 的 数据 进行 比较 ， 目 动 判 
靳 摆 臂 处 是 否 已 经 摆 至 正确 位 置 ， 如 果 是 ， 则 摆 臂 电动 机 停 转 ， 改 为 下 线 运动 电动 机 运动 ; 
如 果 不 是 ， 则 摆 臂 电动 机 继续 摆动 ， 直 至 摆 臂 到 达 合 适 的 位 置 。 

4. 控制 系统 协调 层 

协调 层 是 指 下 位 机 通过 接受 指令 ， 对 各 种 反馈 进行 处 理 协调 ， 同 时 统一 文 配 机 器 人 的 行 
为 。 下 位 机 的 硬件 实现 : PC104 控制 平台 选用 Intel 基于 PC104-PLUS 的 腾 三 租 入 式 处 理 
CPU-1461。 它 最 高 主 频 达 800MHz， 片 内 配备 256MB 的 SDRAM，1MB 的 FLASH EPROML， 
支持 PCI 和 ISA 总 线 。 在 系统 设计 中 配置 2GB 的 内 存 。 为 便于 调试 ， 外 挂 以 太 网 接口 和 两 个 
USB 接口 。 为 接受 超声 波 传感器 信息 ， 设 有 一 个 RS232 标准 串口 。 系 统 采用 CAN 总 线形 式 
实现 各 电动 机 的 控制 ， 因 此 设 有 CAN 总 线 接口 。 系 统 运行 WinCE 操作 系统 。 
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系统 中 采用 PC/104 总 线 方式 ，PC/104 是 一 种 专门 为 艇 入 式 控 制 而 定义 的 工业 控制 总 线 。 
之 所 以 采用 此 总 线 标准 主要 基于 以 下 考虑 : 由 于 特种 搜救 机 器 人 工作 在 非 结构 环境 下 ， 对 环 
境 的 适应 要 求 比较 高 ， 体 积 必须 尽 可 能 小 ， 这 就 要 求 控制 系统 必须 压缩 体积 ，PC/104 总 线 接 
口上 共有 以 下 三 个 特点 : 也 结构 尺寸 小 ， 标 准 模块 的 机 械 尺 寸 是 3.6inx3.8in; 凶 堆 栈 式 连接 ， 
PC/104 总 线 模块 之 间 的 连接 是 通过 上 层 与 下 层 的 和 孔 相 互 紧密 连接 ， 这 种 层 车 式 分 疾 有 极 好 的 
抗震 性 ，(B3) 减 少 元 件数 目 与 电源 消耗 。 

下 位 机 操作 系统 采用 WinCE，WinCE 是 一 个 人 简洁、 局 效率 的 多 平台 操作 系统 。 内 部 采用 
精简 的 RISC 指令 集 。 它 是 从 整体 上 为 有 限 资源 的 平台 设计 的 多 线程 、 完 整 优先 级 、 多 任务 的 
操作 系统 。 

5. 控制 系统 执行 层 

控制 系统 的 执行 层 主要 的 硬件 文 持 有 驱动 器 和 电动 机 。 探 制 原理 为 ， 驱动 器 通过 接收 分 
析 各 种 指令 来 对 电动 机 进行 驱动 ， 同 时 ， 电 动机 编码 器 对 电动 机 转速 进行 检测 并 反馈 给 驱动 
髓 ， 形 成 半 财 环 的 控制 ， 使 控制 精度 更 高 、 更 准确 。 

在 电动 机 选择 问题 上 ， 考 虑 到 机 器 人 执行 任务 过 程 中 有 越 障 、 避风 险 、 快 速 通过 等 
行为 上 的 要 求 , 项 目 组 结合 通过 动力 学 分 析 软 件 ADAMS 建立 机 器 人 机 械 系 统 的 运动 学 和 
动力 学 模型 分 析出 来 的 各 种 动力 学 数据 ， 认 为 电动 机 的 选择 必须 能 满足 机 器 人 的 运动 条 
件 ， 为 其 提供 强大 的 动力 广 持 。 因 此 ， 在 现 有 产品 中 进行 比较 后 ， 最 终 选 择 瑞 十 maxon 公 
司 的 电动 机 ， 其 中 张 动 电动 机 为 maxon DC motor RE40 p40〈 石 ” 电 刷 ，1S$0W)， 摆 臂 电 
动机 为 maxon DC motor RE35 35《〈 石 ” 电 刷 ，90W)。maxon 电动 机 应 用 到 机 闫 人 系统 上 
有 以 下 优势 : 

1 ) 采用 有 刷 电动 机 ,省 去 了 霍 尔 元 件 ,， 这 样 在 驱动 占 制 板 上 将 市 省 了 接口 , 并 减 小 了 体积 。 

2) maxon 电动 机 运行 稳定 , 提供 较 大 的 转 矩 与 转速 ,能 给 搜救 机 器 人 提供 强大 的 动力 文 持 。 

3) maxon 有 良好 的 伺服 性 能 ， 控 制 精确 、 快 速 。 

在 张 动 右 的 选择 上 ， 选 用 了 以 色 列 ELMO 驱动 器 ， 具 体型 扎 为 WHISTLE-WHI 一 20/60。 
此 系列 ELMO 驱动 器 能 稳定 提供 最 高 持续 电流 为 20A, 最 高 持续 电压 为 60V, 能 够 发 挥 maxon 
电动 机 的 最 高 性 能 。 

控制 系统 框架 图 如 图 2-34 所 示 。 
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图 2-34 ”控制 系统 框 染 图 
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6. 控制 系统 的 软件 实现 

本 系统 采用 C/S 软件 体系 结构 ， 客 户 端 为 上 位 机 ， 负 责 人 机 交互 和 对 下 位 机 的 控制 。 下 
位 机 作为 服务 器 端 实时 接受 上 位 机 的 指示 ， 并 完成 相应 任务 ， 同 时 不 断 问 上 位 机 报告 自身 工 
作 状 态 。 上 位 机 与 下 位 机 的 分 工 如 图 2-35 所 示 。 


上 位 机 控制 程序 











无 无 
线 线 
通 通 
信 信 





图 2-35 上 位 机 与 下 位 机 的 分 工 


客户 端 采 用 Visual C++6.0 开发 环境 ， 利 用 MFC 框架 编制 应 用 程序 。 客 户 端 软件 采用 
前 后台 结构 。 前 人 台 负 责 人 机 交互， 后 台 负 责 与 服务 堪 端 的 通信 、 数 据 交 互 、 信 息 融 合 和 路 
径 规 划 。 

利用 MFC 可 以 方便 地 编制 民 好 的 可 视 化 操作 界面 ， 实 现 民 好 的 人 机 交流 。 一 方面 ， 在 前 
台 提 供 视 频 窗口 ， 实 时 显示 下 位 机 的 工作 环境 信息 ， 同 时 显示 下 位 机 上 自 喘 工作 状态 ， 为 用 户 
操作 系统 提供 依据 。 画 一 方面 ， 前 人 台 提 供 操作 界 血 ， 方 便 客 户 对 机 需 人 的 控制 。 操 作 界 面 分 
为 三 大 部 分 : 第 一 部 分 为 摄像 头 控 制 ， 可 以 控制 摄像 头 转 癌 、 调 焦 等 ， 第 二 部 分 为 机 动 控制 ， 
控制 机 天 人 在 一 般 路 况 下 的 运动 状态 ， 包 括 运 动 速度 、 方 向 、 行 程 等 ;第 三 部 分 为 越 障 控制 ， 
控制 机 堪 人 在 复杂 路 况 下 的 运动 ， 包 括 各 种 越 障 方式 的 选择 等 。 

路 径 规 划 子 线程 实现 路 径 规 划 ， 极 大 地 提高 了 机 器 人 的 智能 。 它 负 贡 对 通信 模块 采集 的 
信息 进行 处 理 加 工 ， 通 过 一 定 的 算法 ， 提 供 运 动 控制 指令 。 

运动 控制 模块 分 为 运动 方 癌 控制 和 运动 速度 控制 。 当 机 器 人 进行 搜救 任务 过 程 中 ， 在 
距离 遇难 者 较 远 的 位 置 时 ， 主 要 是 通过 CCD 摄像 头 进行 视觉 的 捕捉 及 方向 的 控制 。 机 器 
人 的 运动 速度 是 通过 它 的 视觉 系统 对 外 界 进行 不 断 的 采集 ， 并 把 采集 到 的 网 像 信 和 息 传 送 到 
上 位 机 进行 决策 、 控 制 ， 从 而 控制 电动 机 的 转速 和 转角 。 可 知 ， 当 障碍 物 的 图 像 较 小 时 ， 
表示 机 堪 人 离 隐 人 碍 物 的 距离 较 远 《〈 在 机 器 人 的 超声 流传 感 锅 能够 检测 到 的 距离 范围 外 )， 
越 隐 机 项 人 采用 全 速 行 驶 《即行 驶 电动 机 的 最 大 转速 ); 当 隧 人 碍 物 的 网 像 较 大 ， 表 示 机 器 
人 离 障 碍 物 已 经 很 近 《〈 在 机 器 人 的 超声 波 传 感 需 能 够 检测 到 的 范围 内 )， 此 时 ， 机 器 人 减 
速 并 最 终 停止 运动 。 

经 反复 的 实验 可 知 ， 在 执行 特种 任务 的 越 隐 机 器 人 遇 到 的 障碍 物 通常 可 分 为 : 前 方 
障碍 物 、 单 侧 障 碍 物 、 两 侧 障 碍 物 。 当 机 器 人 遇 到 前 方 隐 但 物 时 ， 机 器 人 必须 根据 规划 
的 目标 位 置 选择 一 个 避 开 方向 ， 并 且 不 断 融 合 各 个 传 感 需 的 信息 判定 是 人 否 已 避 开 或 绕 开 
障碍 物 。 当 机 器 人 遇 到 单 侧 障 碍 物 时 ， 机 器 人 必须 治 某 一 特定 的 方 癌 转 这 避 开 。 当 机 器 
人 遇 到 两 侧 障 但 物 时 ， 机 器 人 只 能 在 两 侧 障 但 物 的 中 间 通 过 ， 并 且 要 判断 出 宽度 是 否 饮 
机 右 人 通过 。 如 果 不 能 ， 按 第 一 种 障碍 物 类 型 对 和 等， 继续 判断 。 避 障 子 系统 的 程序 流程 
图 如 图 2-36 所 示 。 
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当 机 器 人 距离 障 但 物 较 远 时 


视觉 传感器 判断 障碍 物 大 小 、 与 机 器 人 距离 






控制 机 器 人 的 运动 速度 和 方 问 


超声 传感器 检测 机 器 人 离 障碍 物 的 距离 “| 当 机 器 人 距离 障碍 物 较 近 时 





计算 出 障碍 物 的 高 度 
高 度 是 否 大 于 0. 83m? 


全 采用 越 障 策略 









Y 
调用 避 障 程序 3( 从 两 侧 障 碍 物 的 中 间 通 过 ) 


图 2-36 ”可 障 子 系统 的 程序 流程 图 








搜救 机 右 人 同时 也 具有 优 民 的 越 隐 能 力 ， 它 的 越 隐 子 程序 流程 图 如 图 2-37 所 示 。 当 机 需 
人 距 隐 但 物 较 远 时 ， 控 制 方 法 和 避 障 的 程序 相同 ， 当 机 器 人 距 障 但 物 较 近 时 《在 机 器 人 的 超 
声 传 感 右 能 够 检测 到 的 范围 内 )， 判 断 障 得 物 高 度 ， 如 果 障 租 物 的 高 度 低 于 0.4Sm， 可 知 障碍 














物 可 以 越过 ， 此 时 继续 判断 障 但 物 高 度 是 否 低 于 0.15m， 如 来 低 于 ， 采 用 越 障 程序 1〈 翻 爬 越 
障 法 ) 同时 发 送 控制 指令 人 至 协调 级 控制 层 , 否则 采用 越 隐 程序 2〈， 吴越 隐 法 并 使 后 摆 臂 文 起 ) 
同时 发 送 控制 指令 全 协调 级 控制 技 ， 如 果 障 但 物 的 局 度 局 于 0.4Sm， 表 明 障 但 物 不 可 越过 ,机 
骼 人 后 退 ， 采 用 吉隆 子 程序 。 在 调用 每 个 越 障 子 程序 的 过 程 后 ， 都 要 判断 机 器 人 坪 否 越过 际 
信 物 ， 如 采 越 过 ， 则 结束 越 隐 动作 : 如 果 没 有 ， 则 机 器 人 后 退 ， 调 用 避 降 子 程序 。 
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图 2-37” 越 障 子 程 序 流程 图 

服务 端 主要 完成 两 个 任务 ， 一 方面 实时 的 把 目 身 信息 ， 包 括 超声 流传 感 咒 探测 的 距离 ， 
目 喘 运动 的 速度 和 行程 发 送 给 客户 端 。 另 一 方面 ， 接 受 客 户 问 的 指令 ， 加 以 解 伽 ， 协 调控 制 
各 电动 机 完成 任务 。 

服务 问 也 采用 Visual C++ 编程 ， 利 用 面 癌 对 象 的 思想 ， 采 用 多 线程 技术 加 以 实现 。 程 序 分 
为 三 大 线程 : 监视 和子 线程 、 通 信子 线程 、 执 行 子 线程 。 通 信子 线程 负责 实现 上 下 位 机 的 通信 。 
监视 子 线程 就 负责 监视 机 器 人 的 工作 状态 和 上 位 机 的 操作 指令 ， 只 要 有 有 异 第 操作 发 生 ， 监 视 
子 线程 就 进行 应 急 处 理 。 比 如 ， 硅 工作 在 机 动 状 态 ， 超 声波 传 感 费 测 得 与 障碍 物 距 离 为 L， 月 
吴 运 动 速度 为 v， 而 机 器 人 执行 指令 的 啊 应 时 间 为 7， 则 Zv 接近 了 了 时， 大 上 位 机 还 没 发 送 指 
令 ， 监 视 子 线程 则 强行 分 止 机 器 人 的 运动 ， 并 同上 位 机 发 送 警 告 ， 使 机 峰 人 进入 待命 状态 。 
在 越 障 工作 状态 中 ， 监 视 子 线程 时 刻 监 视 机 器 人 的 动作 ， 当 负载 过 大 有 可 能 烧 坏 电动 机 时 ， 
便 进入 应 急 处 理 状态 。 图 2-38 为 监视 子 程 序 的 流程 图 。 



































开机 ， 初 始 化 程序 ， 设 定 啊 应 


时 间 7T， 预 警 时 间 才 


获取 工作 状态 -sn 


获取 电动 机 工作 状态 


电动 机 负载 正堂 


图 2-38 ”监视 子 程序 的 流程 图 
执行 子 线 程 负 员 对 通信 子 线 程 解码 的 指令 进行 执行 。 采 用 和 面 癌 对 象 的 编程 思想 ， 程 序 设 
计 如 下 : 
























获取 速度 vy， 获 取 距 离 L 





应 急 处 理 ， 进 入 待命 状态 
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建立 了 四 大 类 : 工作 状态 类 (WorkStatus)、 机 动 类 (JiDong)、 越 隐 类 (YueZhang)、 摄 
像 头 类 〈ShexiangTou)。 工 作 状 态 类 负责 封 钱 当前 机 器 人 工作 状态 ,包括 运动 总 体 状 态 〈 机 动 ， 
越 障 )、 运 动 速 度 、 电 动机 工作 状态 、 机 器 人 越 障 姿态 ， 供 其 他 线程 和 类 进行 查询， 机 动 类 未 
小 了 机 右 人 在 机 动 状 态 下 的 各 种 操作 ， 包 括 运 动 方 回 控 制 、 速 度 控 制 ， 越 障 类 封 履 了 各 种 越 
障 姿态 的 实现 ， 援 像 头 类 封装 了 对 摄像 头 的 各 种 操作 。 

通信 子 线程 获得 上 位 机 指令 后 ， 对 指令 进行 解 权 ， 然 后 回执 行 子 线程 有 友 送 消 县 。 执 行 子 
线程 根据 消息 调动 相应 的 类 完成 任务 。 模 块 间 的 接口 示意 图 如 图 2-39 所 示 。 





















通信 模块 解码 


越 障 类 摄像 头 关 


确 层 驱动 器 执行 
电动 机 


图 2-39 模块 间 的 接口 示意 和 网 





2.3.5 “无线 通 信 反 林 


EL， 无线 通信 技术 硬件 分 析 

无 线 通信 模块 是 机 器 人 控制 系统 的 一 部 分 ， 是 连接 决策 管理 模块 和 协调 规划 模块 的 纽 市 。 
其 主要 任务 是 : 在 上 位 机 、 下 位 机 之 间 实 施 实 时 、 高 效 、 无 差错 的 无 线 通信 。 

无 线 通信 模块 的 连接 对 象 是 控制 台 的 上 位 机 和 机 器 人 上 自 带 的 下 位 机 。 连 接 工 具 用 无 线 网 
卡 和 AP。 

由 于 上 下 位 机 都 具有 各 自 独 立 的 操作 系统 (上 位 机 上 安装 的 是 Windows XP， 下 位 机 上 安 
装 的 是 Windows CE)。 所 以 ， 在 设计 机 器 人 无 线 通信 和 解决 方案 时 ， 可 以 将 解决 对 象 的 便 件 平 
台 人 简化 成 两 台 普 通 的 带 有 无 线 网 卡 的 PC。 要 解决 的 问题 ， 驶 是 在 两 侣 带 有 无 线 网 卡 的 PC 之 
间 搭 建 一 个 实时 、 高 效 、 无 差错 的 无 线 通 信 通 道 。 因 此 ， 有 必要 对 通信 信道 提出 要 求 。 

首先 ， 上 位 机 和 下 位 机 之 间 的 通信 必须 是 双 工 形式 。 在 机 器 人 行进 过 程 中 ， 控 制 中 心 需 
要 问 机 器 人 发 送 指令 ， 机 器 人 需要 癌 探 制 中 心 报告 所 处 的 方位 和 上 自身 状态 以 及 任务 的 执行 进 
度 ， 因 此 所 建立 的 通信 通道 必须 是 双 工 的 。 其 次 ， 上 位 机 和 下 位 机 之 间 的 通信 必须 共有 实时 
性 。 在 设计 通信 通道 时 ， 必 须 考虑 到 信息 传递 的 延 时 给 整个 机 器 系统 带 来 的 影响 ， 因 为 所 设 
计 的 机 器 人 面临 的 环境 是 险恶 复 某 的 灾后 环境 ， 并 且 机 器 人 系统 是 运动 的 ， 不 同 的 时 间 面 临 
的 情况 都 不 一 样 ， 每 一 个 微小 的 延 时 都 可 能 导致 整个 任务 的 失败 。 所 以 ， 在 设计 时 必须 考虑 
到 信息 传递 的 延 时 带 来 的 影响 ， 并 尽力 控制 传递 的 延迟 。 最 后 ， 上 位 机 和 下 位 机 之 间 的 通信 
必须 有 反馈 。 机 器 人 执行 的 任务 是 一 个 整体 ， 整 个 任务 过 程 中 的 每 一 个 指令 都 是 环 环 相 扣 的 ， 
残 像 精密 的 仪表 ， 如 有 条 其 中 的 任何 一 环 发 生 了 异种 《比如 延 时 或 丢 包 )， 都 会 引起 连锁 反应 ， 
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导致 任务 的 失败 。 因 此 ， 有 必要 跟踪 每 一 条 指令 ， 监 视 其 执行 的 进度 ， 对 机 器 人 实行 实时 的 
控制 。 因 此 ， 上 位 机 和 下 位 机 之 间 搭 建 的 通行 通道 必须 记录 数据 传输 的 情况 ， 使 信息 的 发 送 
方 可 以 得 到 接收 方 的 反馈。 

2. 无 线 通信 系统 模块 搭建 

借助 开放 系统 互 连 参 考 模型 (Open System Interconnection/Reference Model，OSIRM )， 
建立 搜救 机 器 人 无 线 通 信 系 统 解决 方案 。 

OSI 的 七 层 结构 分 别 为 : 物理 层 、 数 据 链 路 层 、 网 络 层 、 传 输 层 、 会 话 层 、 表 示 层 和 应 用 
层 。 整 体 模型 如 图 2-40 所 示 。 
数据 接收 端 。 
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比特 流 
图 2-40 七 层 结构 的 整体 模型 

对 于 这 个 模型 的 物理 层 和 数据 链 路 层 的 底层 (通常 称 为 媒体 访问 控制 (MAC) 子 层 ) 部 
分 ，IEEE 802.1 规范 已 经 将 其 包括 在 内 。 因 此 ， 只 需要 选用 支持 IEEE 802.11 的 无 线 网 卡 和 
AP 来 搭建 无 线 通 信和 网络 ， 其 通信 模块 图 如 图 2-41 所 示 。 

机 器 人 系统 是 搭建 在 Windows 平台 上 的 ,因此 可 以 在 Windows 操作 系统 平台 上 搭建 应 用 
程序 ， 建立 通信 道 。 作为 Windows 应 用 程序 可 以 使 用 SDK 提供 的 Winsock 功能 加 入 网 络 数 
据 通 信 功 能 ， 这 个 环 市 在 通信 系统 中 相当 于 接口 作用 ， 其 原理 图 如 图 2-42 所 示 。 


API & Protocols (TCP/UDP/IP:… ) 


po Ke Ke roeor 全 了 Fn 


图 2-41 无 线 网 络 通信 模块 图 图 2-42 Winsock 无 线 网 络 原理 图 


对 于 Winsock 来 说 , 现 阶 段 成 熟 的 技术 分 主要 基于 有 连接 传输 CTCP ) 和 无 连接 传输 CUDP ) 
两 关 。 根 据 项 目 实际 ， 将 控制 中 心 设计 为 服务 器 哨 〈Server)， 机 圳 人 设 为 客户 痕 《〈Client)。 
这 样 ， 可 以 实现 一 个 控制 中 心 控 制 多 台 机 费 人 ， 并 进一步 规划 多 个 机 费 人 协作 完成 救灾 场景 


下 的 任务 ， 其 原理 图 如 图 2-43 所 示 。 
_ 


图 2-43 ”基于 无 线 通信 的 多 机 此 人 搜救 系统 原理 图 
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其 中 ， 服 务 器 应 建立 连接 流程 如 网 2-44 所 示 。 其 中 ， 初 始 化 环境 包括 : 获得 SOCKET 
对 象 ， 设 置 IP 地 址 值 ， 绑 定 SOCKET 对 象 和 IP 地 址 ， 关 闭 连 接 包括 清理 环境 等 。 

客户 端 建立 连接 流程 图 如 网 2-45 所 示 。 其 中 ， 初 始 化 环境 包括 : 获得 SOCKET 对 象 ， 设 
置 IP 地 址 值 ， 关 闭 连 接 包括 清理 环境 等 。 


初始 化 环境 jl 




















初始 化 环境 1 
连接 到 服务 需 1 
传输 数据 1 


关闭 连接 






允许 客户 端 连 入 


2 
传输 数据 
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关闭 连接 





















图 2-44 服务 需 中 建立 连接 流程 图 2-45 客户 站 建立 连接 流程 图 


主要 创新 点 及 取得 的 成 果 





2.4.1 ”作品 主要 创新 挟 


作品 主要 创新 点 如 下 : 

1) 新型 特种 搜救 机 费 人 具有 四 个 可 录 活 反动 的 履 高 恬 ， 机 刁 完 全 被 行走 履 市 包 窗 ， 因 此 
其 其 有 极 强 的 地 形 适 应 能 力 和 机 动 性 。 在 通过 障碍 时 不 会 出 现 一 般 履 带 机 各 人 经 第 过 到 的 因 
慌 盘 友人 碰 而 进退 两 难 等 状况 ， 上 其 有 较 遇 的 攀 扑 和 越 障 能 力 。 以 电动 机 作为 主动 轮轴 ， 对 主动 
轮 起 到 文 撑 、 定 位 和 张 动 的 多 重 作 用 ， 简 化 了 传动 机 构 ， 省 去 了 传统 传动 方式 中 的 轴承 件 ， 
减轻 了 张 动 朔 置 的 重量 ， 此 外 ， 主 动 轮 与 摆 辟 都 是 由 张 动 电动 机 直接 驳 动 ， 省 去 了 烦琐 的 传 
动机 构 ， 最 大 限度 地 市 省 了 空间 ， 降 低 了 系统 故障 紊 ， 为 特种 搜救 机 占 人 进一步 小 型 化 、 轻 
量化 提供 了 解 次 方案 。 

2) 控制 系统 采用 分 层 递 阶 的 控制 体系 结构 ， 主 要 包括 : 决 朱 层 、 通 信 层 、 协 调 层 和 
执行 层 。 决 策 层 使 机 器 人 系统 具有 一 定 程 度 的 目 主 性 ， 可 将 外 部 环境 变化 或 操作 者 指令 所 
引起 的 系统 内 部 啊 应 经 过 分 析 和 判断 ， 形 成 对 整个 机 磊 人 系统 的 控制 决策 ;通信 层 主 要 负 
页 实施 实时 、 局 效 、 无 差错 地 与 控制 中 心 进行 通信 。 协 调 层 是 对 所 执行 任务 进行 分 解 ， 并 
对 任务 执行 情况 进行 有 反馈。 执行 层 通 过 驱动 各 个 执行 部 件 来 实现 机 右 人 的 运动 和 动作 ， 从 
而 准确 高 效 地 完成 任务 ， 并 且 采 用 遥控 与 日 主 控制 相 结合 的 方式 ， 提 噩 了 搜救 机 左 人 的 应 
用 价值 。 

3) 实用 价值 大 。 新 型 特种 搜救 机 右 人 设计 新 神 、 结 构 独 特 ， 采 用 先进 的 能 源 窟 理 拉 术 ， 
将 动态 电源 管理 超时 算法 运用 到 电源 管理 系统 进行 控制 ， 有 效 地 降低 了 功 耗 ， 提 高 了 巡航 时 
间 ; 功能 模块 丰富 、 集 成 度 品 ， 和 而 且 可 进行 扩展 或 裁 沪 ， 操作 人 简单 、 可 徘 性 蜗 。 以 上 这 些 特 
太保 证 了 新 型 特种 搜救 机 右 人 可 有 效 地 投入 使 用 ， 迅 速 融 效 地 完成 搜救 任务 。 
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2.4.2 ”作品 取得 的 成 果 


作品 取得 的 成 果 如 下 : 

1) 新 型 特种 搜救 机 器 人 原理 样机 1 台 。 

2) 新 型 特种 搜救 机 器 人 研究 报告 1 份 。 

3) 发 表 学 术 论 文 2 篇 。 

4) 获得 国家 发 明 专利 2 项 : 

GD 小 型 四 履 市 移动 机 器 人 张 动 装置 ， 专 利 号 : CN101007548。 

Go 小 型 六 履 市 全 地 形 移 动机 器 人 ， 专 利 写 : CN101077717。 

5) 获 第 二 届 全 国 大 学 生 创新 论坛 “我 最 喜爱 的 10 件 作 品 ” 称 号 ， 排 名 第 三 。 


忆 结 与 展望 





DS4 








2.5.1 作品 研发 工作 总 结 


新 型 特种 搜救 机 器 人 以 第 二 届 国 家 大 学 生 创新 性 实验 计划 为 依托 ， 在 学 校 教 务 处 的 计划 
和 安排 下 逐步 展开 。 项 目 研 友 思路 图 如 图 2-46 所 示 。 

















电动 机 控制 系统 学 习 


电源 系统 学 习 | | 基础 研究 


传感器 系统 学 习 ”一 





原理 样机 实现 


图 2-46 项 目 研 发 思路 图 

研发 工作 分 为 三 个 主要 环 世 ， 基 础 研究 、 实 验 研 究 、 前 沿 技术 研究 。 三 个 环 币 循序 渐进 ， 
相互 补充 ， 最 终 实现 原理 样机 。 

项 目 组 在 指导 老师 昔 宝 玲 教授 和 罗 庆 生 教 授 的 指导 下 ， 提 出 “明确 目标 、 目 觉 行动 、 
求 方法 ”的 简练 目标 ， 实 行 每 周 讨 论 、 周 记 书 号、 理论 学 习 和 实验 操作 相 结 合 的 研究 思路 。 
总 共 完 成 十 次 “ 周 讨论 ”四 次 项 目 组 成 员 “ 小 ” 座 ” 分 别 对 该 项 目的 总 体 设 计 、 机 构 设 计 、 
运动 控制 、 传 感 与 探测 、 能 源 管理 等 部 分 进行 了 细致 的 讨论 , 并 集体 学 习 了 VC 编程 、 ADAMS 
基础 、MATLAB、CAN 总 线 等 知识 ;项 目 组 利用 评 余 时 间 调 碍 市 场 ， 进 行 需 求 分 析 、 产 品 选 
型 ， 为 原理 样机 的 实现 葛 定 了 民 好 的 基础 ;项 目 组 核心 成 员 利 用 专业 知识 ， 搜 集 搜 救 机 上 右 人 
相关 文献 、 专 利 ， 认 真 总 结 、 借 鉴 ， 反 复 论 证 。 

项 目 管理 借鉴 科技 事业 中 科技 管理 ， 引 导 组 员 积 极 主动 地 完成 任务 ， 实 现 “1+1>2” 的 目 
标 。 项 目 组 从 切实 的 小 事 做 起 ， 规 定 合理 的 制度 和 原则 ， 开 会 讨论 记 笔 记 、 不 到 到 不 早退 、 
认真 完成 周记 、 明 确 财务 支出 状况 并 登记 在 案 、 明 确 书籍 借阅 制度 等 ， 同 时 积极 ” 励 和 引导 
同学 们 克服 困难 ， 完 成 现 阶段 任务 ， 并 且 结 合 新 理论 、 新 发 明 等 方面 开 折 各 个 阶段 任务 的 思 
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路 ， 将 项 目 完 成 到 的。 


2.5.2 成果 应 用 范围 及 前 景 分 析 


类 国 紧 总 救援 办 公 室 的 统计 数据 表明 ， 从 狭小 的 封闭 空间 中 营救 1 名 秆 人 存 者 平均 需要 
10 个 救援 人 员 人 花费 4 个 小 时 的 时 间 。 而 使 用 救援 机 需 人 进行 辅助 援救 是 解决 上 述 难题 的 有 
效 手段 。 例 如 ， 在 2001 年 美国 9。11 事件 中 ， 救 援 机 如 人 束 起 到 了 重要 的 作用 ， 美 国 机 可 
人 辅助 救援 中 心 和 其 他 一 些 单位 的 搜救 机 右 人 参与 了 此 次 救援 行 动 。 在 此 次 救援 行动 中 ， 搜 
救 机 各 人 体现 出 了 其 较 强 的 复 配 地 形 适 应 能 力 和 极 强 的 搜救 能 力 ， 表现 非 第 令 人 酒 意 ， 从 而 
推动 了 搜救 机 需 人 在 全 球 范 围 内 的 研究 与 应 用 。 搜 救 机 器 人 在 灾难 救援 中 捷 体 现 出 的 优势 在 
于 : 届 可 以 连续 作业 ， 执 行 艰难 、 困 二 的 搜索 救援 任务 ， 能 够 深入 危险 地 带 获取 影像 资料 供 
研究 人 员 分 析 ; 包 可 以 在 搜救 人 员 和 搜救 ”无 法 进入 的 狭 罕 空 间或 危险 地 市 中 执行 任务 ， 引 
起 二 次 ” 塌 等 危险 的 可 能 性 较 小 ，(3) 受 救援 环境 有 害 因 素 影 响 小 。 

搜救 机 器 人 将 机 械 设计 技术 、 智 能 控制 技术 、 传 感 探 测 技术 、 营 救 行动 技术 和 灾难 学 等 
多 学 科 的 知识 有 机 融合 ， 是 当代 机 器 人 学 研究 中 一 个 让 有 挑战 性 的 新 领域 。 新 型 搜救 机 右 人 
能 提高 救援 的 效率 和 成 功率 ， 减 少 救援 过 程 中 不 必要 的 伤 半 ， 有 具有 广阔 的 应 用 前 景 和 市 场 价 
值 。 同 时 ， 人 研发 搜救 机 器 人 所 涉及 的 设计 理念 、 关 键 技 术 、 实 验方 法 对 其 他 的 相关 项 目 也 具 
有 很 好 的 借鉴 意义 。 
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(第 三 届 全 国 大 学 生 创新 年 会 “我 最 喜爱 的 10 个 项 目 ,排名 第 五 , 2010 年 ) 


作品 研究 的 背景 及 总 义 


轮 陈 运动 被 认为 是 效率 最 高 的 运动 形式 ， 但 它 只 适用 于 平坦 路 面 ， 对 于 复杂 的 地 形 ， 腿 式 运 
动 比 轮 式 运动 要 优越 得 多 。 研 究 表明 : 当 多 足 动 物 罕 过 复杂 地 形 时 ， 会 对 过 到 的 障碍 物 进 行 目 我 
调节 ， 这 是 轮 式 机 器 人 无 法 比拟 的 。 比 如 螃 螂 ， 其 速度 之 快 令 人 怀 叹 。 虹 螂 每 路 一 步 只 需 S0ms， 
速度 可 达 20cm/s， 可 以 讨 过 目 身 高 度 3 倍 的 隐 碍 物 而 无 需 减 速 。 从 对 凡 野 的 运动 过 程 的 研究 中 ， 
我 们 可 以 总 结 出 : 多 足 机 器 人 腿 与 腿 之 间 是 各 目 独 立 的 ， 能 实现 每 条 腿 的 不 同 动作 ， 其 运动 方式 
其 有 较 好 的 机 动 性 ， 使 机 絮 人 更 能 适应 不 平 的 地 面 ; 由 于 腿 之 间 的 相互 独立 ， 因 此 即使 地 面 不 平 
坦 ， 也 能 靠 控 制 腿 的 协调 动作 来 保持 机 吴平 称 ， 起 到 防 振作 用 ;多 足 机 器 人 在 不 平 或 者 松软 的 地 
面 上 运动 时 也 能 以 较 高 速度 行走 ， 比 起 轮 式 机 器 人 的 能 量 消耗 也 少 得 多 。 

鉴于 蝶 螂 运动 的 独特 优点 ， 近 年 来 仿生 蝶 螂 机 器 人 在 机 器 人 学 界 得 到 了 蜗 上 度 重 视 和 快速 
发 展 。 从 仿生 晤 螂 机 器 人 的 发 展 历程 来 看 ， 上 共有 代表 性 的 仿生 晤 螂 机 器 人 大 致 可 分 为 以 下 三 
种 类 型 : 

1) 第 一 种 为 Robot 系列 景 晴 机 堪 人 ， 如 图 3-1 所 示 。 访 系列 机 器 人 是 由 美国 弛 斯 西 储 大 
学 (Case Western Reserve University) 研制 的 ， 其 外 形 为 仿生 设计 。Robot I 的 各 条 腿 的 上 自由 
度 分 布 并 不 均匀 ， 前 腿 为 5 个 ， 中 腿 为 4 个 ， 后 腿 为 3 个， 共 24 个 自由 度 ， 其 驱动 方式 为 气 
压 驱 动 ， 可 获得 较 大 的 爆发 力 。Robot IV 是 在 Robot II 的 基础 上 研制 而 成 的 ， 它 的 驱动 方式 采 
用 了 人 工 肌肉 ， 上 共有 更 好 的 仿生 效果 。 






































图 3-1 Robot 系列 虹 螂 机 器 人 
a) Robot IJ b) Robot IV 


2) 第 二 种 为 Whegs 系列 暗 晴 机 器 人 ， 如 图 3-2 所 示 ， 其 外 形 设 计 不 是 简单 的 机 械 仿 生 ， 
而 是 抽象 出 蜂 螂 运动 的 特点 进行 功能 模拟 ， 仍 由 美国 弛 斯 西 储 大 学 (Case Western Reserve 
University) 研制 。 该 系列 机 器 人 的 每 条 腿 都 只 有 一 个 旋转 目 由 上 度 以 进行 轮 式 运动 ， 每 条 腿 是 











一 个 相互 间隔 120” 的 三 轮 副 结构 ， 是 一 种 基于 生物 学 原理 抽象 而 成 的 6-DOF 功能 新 型 轮 腿 
人 
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a) b) C) 
3-2 Whegs 系列 暗 螂 机 堪 人 
a) Whegs | b) Whegs l[[ c¢) Whegs [lI 
3) 第 三 种 为 RHex 系列 昱 螂 机 器 人 ， 如 图 3-3 所 示 。 该 系列 机 器 人 和 Whegs 系列 昱 晴 机 
医 人 一 样 ， 也 是 一 种 从 生物 学 原理 中 抽象 出 来 的 6-DOF 功能 新 型 轮 腿 式 机 疾 人 ， 由 美国 密 执 
安 大 学 (University of Michigan)、 加 利 福 尼 亚 大 学 伯克利 分 校 (UC Berkeley) 和 加 拿 大 卖 吉 











图 3-3 RHex 系列 暗 晴 机 堪 人 
a) 早期 样机 b) 近期 样机 


生物 学 研究 表明 ， 赚 螂 虽然 运动 敏捷 ， 但 其 神经 系统 却 非 常 简单 ， 这 说 明 赚 螂 在 运动 过 








程 中 ， 其 中 枢 神 经 并 不 一 直 处 于 工作 状态 ， 其 各 腿 的 运动 受 控制 器 的 目 主 控制 。 因 此 轮 腿 式 
机 絮 人 的 控制 系统 一 般 采 用 主 从 分 布 式 控 制 结构 。 脑 级 主 控 制 占 依据 规划 的 任务 要 求 ， 为 各 
腿 级 控制 占 分 配 任务 ， 腿 级 主 控制 费 依 据 所 需 执行 的 任务 要 求 问 它 的 从 控制 鼎 发 布 命 仿 。 上 
下 级 控制 郝 之 间 进 行 信息 交互 ， 从 而 实现 智能 运动 控制 。 





(1) 运动 机 理 仿生 ”运动 仿生 是 仿生 机 器 人 研发 的 前 所， 而 进行 运动 仿生 的 关键 在 于 对 
运动 机 理 的 建 模 。 在 具体 研究 过 程 中 ， 应 首先 根据 研究 对 象 的 具体 技术 需求 ， 有 选择 地 研究 
东 些 生物 的 结构 与 运动 机 理 ， 借 助 于 高 速 摄影 机 或 录像 设备 ， 结 合 解 训 学、 生理 学 和 力学 等 
学 科 的 相关 知识 ， 建 立 押 需 运 动 的 生物 模型 ; 在 此 基础 上 进行 数学 分 机 和 抽象 ， 提 取出 内 部 
的 关联 函数 ， 建 立 仿生 数学 模型 ， 最 后 ， 利 用 各 种 机 械 、 电 子 等 方法 和 手段 ， 根 据 抽象 出 的 
数学 模型 加 工 出 仿生 的 软 、 人 硬件 模 型 。 

生物 原型 是 仿生 机 硕 人 的 研究 基础 ， 软 便 件 模型 是 仿生 机 器 人 的 研究 目的 ， 而 数学 模型 
则 是 两 者 之 间 必 不 可 少 的 桥梁 。 只 有 借助 于 数学 模型 才能 从 本 质 上 深刻 地 认识 生物 的 运动 机 
理 ， 从 而 不 仅 模 仿 目 然 界 中 已 经 存在 的 两 是 、 四 是 、 六 中 及 多 足 行走 方式 ， 同 时 还 可 以 创造 
出 目 然 界 中 不 存在 的 一 是 、 三 中 等 行走 模式 及 轮 腿 式 运动 等 。 
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(2) 控制 机 理 仿生 ”控制 仿生 是 仿生 机 各 人 研发 的 基础 。 要 适应 复 傈 多 变 的 工作 环境 ， 仿 
生机 器 人 必须 具备 强大 的 导航 、 定 位 、 控 制 等 能 力 ;， 要 实现 多 个 机 右 人 间 的 无 际 配 合 ， 念 生机 
佣 人 必须 具备 展 好 的 群体 协调 控制 能 力 ， 要 解决 纷 么 复杂 的 任务 ， 完 成 目 身 的 协调 、 完 善 及 进 
化 ， 仿 生机 堪 人 必须 具备 精确 开放 的 系统 控制 能 力 。 如 何 设 计 该 核心 控制 模块 与 网 络 以 完成 目 
适应 、 群 控制 、 类 进化 等 这 一 系列 问题 ， 己 经 成 为 仿生 机 费 人 研发 过 程 中 的 首要 难题 。 

(3) 信息 感知 仿生 ”感知 仿生 是 仿生 机 器 人 研 友 的 核心 。 为 了 适应 未 知 工作 环境 ， 代 和 替 
人 完成 危险 、 单 调和 困难 的 工作 ， 机 右 人 必须 具备 包括 视觉 、 听 和 沉 、 蜗 觉 、 接 近 沉 、 和 触觉 等 
多 重 感 觉 在 内 的 强大 的 感知 能 力 。 单 纯 的 感 测 信 号 并 不 复 杀 ， 重 要 的 是 理解 信号 所 包含 的 有 
价值 的 信息 ， 因 此 ， 和 人们 必须 全 和 面 运用 各 种 时 域 、 频 域 的 分 析 算 法 和 智能 处 理工 具 ， 充 分 融 
合 各 传 感 右 的 信息 ， 相 互补 序 ， 才 能 从 复杂 的 环境 噪声 中 迅速 地 提取 出 所 需 的 正确 的 敏感 信 
县 ， 并 克服 信息 元 余 与 冲突 ， 提 高 反应 的 迅速 性 和 确保 决策 的 科学 性 。 

(4) 能 量 代 谢 仿生 “能量 仿生 是 仿生 机 磊 人 研发 的 关键 。 生 物 的 能 量 转换 效率 最 高 可 达 
100%， 有 上 肌肉 把 化 学 能 转变 为 机 械 能 的 效率 也 接近 50%， 远 远 超过 目前 各 种 工程 机 械 。 肌 肉 还 可 
以 目 我 维护 ， 长 期 使 用 。 因 此 ， 要 缩短 能 量 转换 过 程 ， 提 高 能 量 转换 效率 ， 建 立 易 于 维护 的 代 
谢 系 统 ， 就 必须 重新 回 到 生物 原型 ， 研 究 模仿 生物 直接 把 化 学 能 转换 成 机 械 能 的 能 量 转换 过 程 。 

(5) 材料 合成 仿生 ”材料 仿生 是 仿生 机 器 人 研发 的 重要 部 分 。 许 多 仿生 材料 具有 无 机 材 
料 所 不 可 比拟 的 特性 ， 如 民 好 的 生物 相 容 性 与 力学 相 容 性 ， 并 且 生 物 合成 材料 技能 高 超 、 方 
法 人 简单， 所 以 研究 目的 的 一 方面 在 于 学习 生物 的 合成 材料 方法 ， 生 产 出 局 性 能 材料 ， 为 一 方 
面 是 为 了 制造 有 机 元 占 件 。 因 此 仿生 机 占 人 的 建立 与 最 终 实现 并 不 仅仅 依赖 于 机 、 电 、 液 、 
光 等 无 机 元 需 件 ， 还 应 结合 和 利用 仿生 材料 近 制 造 的 有 机 元 闫 件 。 

本 研究 的 目的 在 于 研制 一 种 能 够 在 不 同 地 形 条 件 下 高 速 机 动 行 驶 并 具有 一 定 越 障 能 力 的 
微型 新 型 轮 腿 式 机 右 人 。 该 机 器 人 具有 结构 紧凑 、 机 动 灵活 、 运 动能 力 强 、 适 应 能 力 好 等 优 
扩 ， 可 以 在 复杂 地 形 条 件 下 执行 特殊 使 命 。 

狐 型 轮 腿 式 机 器 人 的 研究 在 发 达 国 家 也 才 不 过 十 几 年 的 历程 ， 而 我 们 国家 更 只 是 处 于 刚 
Ee 步 的 阶段 。 因 此 ， 开 展 这 一 课题 的 研究 ， 对 于 提 局 我 国 在 该 领域 的 研究 水 平 ， 赶 上 国际 先 
进 水 平 具 有 重要 意义 。 另 外 ， 对 于 日 益 增 加 的 目 然 或 人 为 惑 急 所 根 成 的 灾害 《例如 地 震 、 委 
灾 、 丰 难 等 )， 尤 其 是 在 危险 或 人 关 无 法 到 达 的 场合 中 ， 新 型 轮 腿 式 机 右 人 都 有 很 好 的 应 用 前 
景 ， 能 够 大 大 提高 救援 的 效率 ， 保 障 人 民 的 生命 安全 。 


作品 概述 


3.2.1 ”人 研究 内 容 概述 


以 Robot 系列 为 代表 的 结构 型 轮 腿 式 机 需 人 的 目 由 度 较 多 ， 可 实现 六 足 昆虫 腿 部 的 灵活 
运动 ， 同 时 在 结构 上 会 尽 可 能 地 模仿 昆虫 的 外 形 设计 。 由 于 目 由 度数 量 较 多 ， 这 类 机 各 人 可 
实现 精确 的 定位 和 理想 的 姿势 。 因 此 ， 这 关机 器 人 适用 于 精度 要 求 较 遍 的 场合 ， 如 防 煤 、 采 
集 样 本 等 。 而 以 Whegs 和 RHex 为 代表 的 功能 型 轮 腿 式 机 需 人 通 凋 没有 “ 旦 螂 ”的 外 形 结 构 ， 
相 比 之 下 ， 生 更 像 是 六 轮 驱 动 的 小 车 。 这 种 机 器 人 主要 模仿 晤 螂 的 快速 移动 功能 ， 比 起 结构 
仿生 ， 这 种 功能 型 轮 腿 式 机 右 人 的 定位 精度 相对 较 送 ， 不 过 在 运动 机 能 上 却 是 仿 结构 机 右 人 
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无 法 比拟 的 。 因 此 ， 这 类 机 上 右 人 适用 于 侦查 、 探 索 等 情况 。 本 作品 研究 的 是 第 二 类 机 如 人 ， 
即 功 能 型 轮 腿 陈 机 堪 人 ， 外 称 新 型 轮 腿 陈 机 闫 人 。 

1. 机 械 结构 设计 

机 构 设 计 是 独 型 小 尺寸 、 轻 体重 、 多 用 途 轮 腿 式 机 器 人 研究 的 基础 ， 机 构 设 计 的 优 劣 下 
接 影 啊 到 机 硕 人 的 灵活 性 和 机 动 性 。 在 二 代 样 机 的 基础 上 上 ， 对 新 型 轮 腿 式 机 磊 人 的 整体 结构 
进行 改 民 设计， 看 和 章 于 驱 体 及 足 部 结构 的 调整 。 相 关 功 能 要 求 可 归纳 为 WD 具 有 一 定 的 承载 
能 力 ， 运 动 灵 活 ; 凶 能 癌 前 、 辣 后 行驶 ， 转 健 ， 具 有 一 定 的 避 隧 和 欧 登 侣 阶 的 能 力 ;， 凶 重心 
要 求 在 “三 角 步 态 ” 所 构成 的 三 角形 内 ， 以 实现 机 体 平 稳 运 行 。 

2. 步 态 分 析 

步 态 分 析 是 狐 型 轮 腿 式 机 器 人 实现 多 种 行走 方式 的 基础 ， 也 是 驱动 电动 机 选择 计算 时 所 
需 考 虑 的 ， 同 时 也 为 Pro/Engineer 建 模 和 3ds Max 动画 制作 做 一 定 的 资料 准备 。 该 部 分 研究 主 
要 包括 机 器 人 起 动 步 态 分 析 、 直 线 行走 步 态 分 析 〈 包 括 慢 速 前 进 和 快速 前 进步 态 ) 及 转 这 步 
态 分 析 ( 包 括 行进 中 转 玖 和 原 地 转 寄 步 态 )。 

3. 控制 系统 设计 

针对 不 同 任务 和 作业 需要 ， 新 型 轮 腿 式 机 需 人 有 时 需要 快速 通过 和 危险 区 ， 有 时 需要 欧 爬 
和 越 障 ， 有 时 需要 低速 巡航 ， 因 而 必须 研究 其 在 不 同 作业 环境 中 的 运动 控制 技术 。 其 控制 系 
统 的 设计 主要 包括 控制 系统 便 件 设计 、 软 件 设计 及 驱动 电动 机 的 选 型 计算 。 

狐 型 轮 腿 式 机 器 人 控制 系统 的 便 件 构成 采用 移动 式 控制 平台 、 网 入 式 分 布控 制 系 统 和 多 
传感器 信息 融合 系统 组 成 。 移 动 式 控制 平台 由 便携 式 计算 机 、 无 线 数 据 传输 模块 、 控 制 右 等 
便 件 组 成 ， 作 为 人 机 交互 便 件 平台 ; 骸 入 式 控制 系统 采用 基于 CAN 总 线 的 艇 入 式 分 布 系统 方 
宁 ， 安 置 于 机 右 人 机 体内 部 ， 由 运动 控制 单元 、 电 动机 控制 捍 元 两 部 分 组 成 ， 多 传 感 占 信息 
融合 系统 采用 基于 Cortex-M3 核心 的 数据 采集 单元 ， 用 于 采集 电动 机 运动 信息 、GPS、 超 声 汲 
传 感 占 、 红 外 探测 器 及 能 源 状 态 信息 ， 在 网 入 式 控制 系统 中 统一 处 理 。 

控制 系统 软件 是 控制 系统 的 核心 ， 主 要 完成 调度 、 协 调 系统 各 个 便 件 梗 块 的 工作 ， 实 现 
信息 整合 、 任 务 分 配 、 运 动 管理 等 功能 。 新 型 轮 腿 式 机 器 人 的 软件 系统 由 总 探 平 台 软 件 和 机 
载 系 统 软件 两 大 部 分 组 成 。 总 控 平台 软件 运行 于 便携 式 计算 机 中 ， 主 要 由 运动 行为 规划 模块 、 
视频 显示 模块 、 实 时 数字 图 像 处 理 模块 每 组 成 ， 机 载 系 统 软件 以 艇 入 式 实 时 多 任务 操作 系统 
Linux 为 开发 平台 ， 采 用 面 癌 对 象 的 多 线程 编程 技术 开发 完成 。 

4. 机 器 人 运动 仿真 与 样机 实验 

通过 三 维 动画 的 制作 和 演示 ， 可 对 新 型 轮 腿 式 机 器 人 的 结构 、 闭 配 过 程 及 各 种 步 态 有 清 
晰 的 了 解 。 运 用 3ds Max 软件 对 狐 型 轮 腿 式 机 右 人 进行 三 维 渤 示 动画 的 制作 。 结 合理 论 分 析 
计算 结果 ， 利 用 3ds Max 对 机 器 人 执行 三 角 步 态 时 各 腿 间 的 相互 关系 进行 模拟 仿真 ， 以 确定 
正人 确 的 运动 参数 。 在 虚拟 仿 丰 的 基础 上 ， 进 行 狐 型 轮 腿 式 机 器 人 样机 实验 ， 以 验证 理论 分 析 
与 仿真 分 析 的 正确 性 。 


3.2.2 ”技术 指标 


1) 长 三 500mm， 宽 三 300mm， 高 宇 250mm， 重 量 三 16kg， 有 效 载 荷 15kg。 
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2) 平均 巡航 速度 为 100m/min， 最 大 巡航 速度 为 150m/min， 欧 越 障 人 碍 高 展 为 0.3m， 疏 坟 
度 为 40" 。 

3) 摄像 头角 上 度 变 化 范围 0 一 90”， 通 过 视觉 传感器 采集 周边 环境 信息 实时 传输 给 控制 中 
心 ， 操 探 人 员 可 根据 现场 实时 图 像 进 行 有 效 操控 ， 无 线 通 信和 距离 为 1.5km。 

4) 可 在 丘陵 、 沙 漠 、 章 原 、 滩 涂 、 林 地 等 复杂 地 形 区 域 高 效 机 动 地 执行 各 类 特种 作 
业 任 务 。 


天 键 近 术 





























3.3.1 ”机 器 人 结构 设计 


1. 总 体 方案 的 选择 和 确定 

新 型 轮 腿 式 机 器 人 采用 三 角 步 态 行走 ， 因 此 可 把 6 条 腿 分 为 两 组 ， 身 体 一 侧 的 前 腿 、 后 
腿 与 另 一 侧 的 中 间 腿 为 一 组 ， 两 组 腿 交 蔡 摆 动 与 文 撑 ， 使 机 喘 一 直 处 于 相对 平稳 的 状态 。 

通过 查阅 相关 资料 可 知 ， 功 能 型 辊 腿 式 机 上 右 人 的 运动 原理 较为 人 简单， 把 电动 机 的 功 京 及 
转速 引出 来 分 别传 送 到 两 组 腿 上 ， 使 其 同步 即 可 。 因 此 ， 设 计 出 以 下 几 种 方案 : 

1) 方案 一 : 将 两 组 腿 错 开 180” 布 置 ， 用 一 个 电动 机 市 动 ， 通 过 蜗杆 蜗轮 、 同 步 市 、 锥 
齿轮 等 传动 装置 进行 动力 传递 ， 实 现 两 组 腿 的 运行 。 

2) 方案 二 : 选用 两 个 电动 机 分 别 对 两 组 腿 进行 单独 控制 ， 同 样 需要 同步 带 等 传动 机 构 来 
实现 三 角 步 态 的 运行 。 

3) 方案 三 : 选用 六 个 电动 机 对 每 一 个 腿 进 行 单独 控制 ， 这 样 可 省 去 传动 装置 部 分 ， 和 直接 
由 电动 机 币 动 腿 运 转 。 

比较 以 上 三 个 方案 : 方案 一 只 选择 了 一 个 电动 机 ， 能 很 好 地 实现 两 组 腿 之 间 的 同步 问题 。 
但 传动 装置 太 多 ， 必 须 加 大 箱 体 才能 装载 所 有 零件 ， 同 时 两 组 腿 之 间 被 相对 “固定 ”成 180” 布 
置 ， 只 有 一 个 旋转 自由 度 ， 这 样 一 来 使 机 器 人 灵活 性 不 够 ， 只 能 单纯 地 完成 直线 行进 ， 无 法 实 
现 转 营 等 功能 。 方 案 二 在 方案 一 的 基础 上 有 所 改进 ， 能 分 别 控 制 两 组 腿 的 不 同 运 动 ， 目 由 度数 
为 2， 但 方案 一 中 存在 的 问题 仍 没 有 得 到 有 效 的 解决 。 方 案 三 中 采用 六 个 电动 机 进行 控制 ， 机 器 
人 有 6 个 旋转 目 由 度 ， 腿 与 腿 之 间 的 同步 不 易 满 足 ， 但 由 于 省 去 了 传动 装置 部 分 ， 大 大 节省 了 
机 体内 的 空间 。 同 时 ， 由 于 六 条 腿 相 对 独立 ， 通 过 控制 电动 机 间 的 转速 差 ， 可 进一步 实现 原 地 
转 要 、 行 进 中 转 人 要、 四 足 其 全 多 足 同 时 看 地 等 动作 ， 使 机 融 人 的 运动 更 为 灵活 多 变 ， 更 能 适应 
恶劣 的 环境 。 男 一 方面 ， 考 虑 到 这 种 独 型 辊 腿 式 机 器 人 的 主要 特点 是 可 禹 速 行进 ， 用 于 完成 侦 
但 等 任务 ， 对 各 腿 同 步 的 要 求 并 不 高 ， 因 此 ， 选 用 第 三 种 方案 进行 设计 。 

2. 结构 设计 

采用 Pro/E 三 维 建 模 软件 对 新 型 轮 腿 式 机 器 人 的 机 械 结 构 进 行 设计 造型 。 新 型 轮 腿 式 机 器 
人 的 基本 结构 主要 包括 躯体 、 腿 部 和 驶 动 装置 。 按 照 Pro/E 建 模 的 规则 ， 使 用 各 种 适当 的 建 模 
方法 〈 拉 伸 、 旋 转 、 扫 描 、 镑 像 等 ) ， 对 机 器 人 的 各 部 分 结构 进行 造型 。 

(1) 驱 体 造型 设计 新 型 轮 腿 式 机 器 人 的 蝶 体 采用 框架 式 结 构 ， 其 三 维 实 体 模型 和 实物 
分 别 如 图 3-4 和 图 3-5 所 示 。 
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a) b) 


图 3-4 ”新 型 轮 腿 式 机 器 人 驱 体 的 三 维 实体 模型 
a) 侧 板 模型 b) 躯体 整体 模型 








图 3-5 ”新 型 轮 腿 式 机 器 人 驱 体 实物 图 


(2) 腿 部 造型 设计 we 
所 示 。 如 图 3-6a 所 示 ， 机 器 人 腿 部 由 两 个 单 足 和 联 轴 器 组 成 。 两 个 单 足 分别 呈 180” 对 称 安 
在 联 时 器 的 两 侧 ， 用 曝 钉 加 以 固定 。 单 足 的 具体 形状 如 图 3-6b 所 示 ， 之 所 以 将 机 器 人 的 足 部 设 
计 成 踊 形 ， 主 要 是 踊 形 足 部 上 共有 以 下 优势 : 了 与 且 杆 结构 相 比 ， 弧 形 结构 在 机 器 人 从 “ 苇 ” 到 
“站 ”的 过 程 中 ， 受 力 点 更 接近 电动 机 回转 轴 ， 如 图 3-8 所 示 ， 因 此 电动 机 所 需 的 扭矩 较 小 ， 
减 小 了 电动 机 的 负担 ， 同 时 增 大 了 电动 机 选择 的 范围 ， 包 比 起 直 杆 结构 弧 形 结构 的 触 地 面积 更 
大 ， 防 滑 性 能 更 为 优越 ;人 在 遇 到 复杂 地 质 条 件 的 地 形 时 ， 例 如 石 缝 、 滩 浴 等 ， 志 杆 式 足 部 容 
易 陷 入 其 中 ， 使 得 机 器 人 进退 困难 ， 而 弧 形 足 部 却 能 大 大 降低 这 种 风险 。 

(3) 张 动 钱 置 造 型 ”新 型 轮 腿 式 机 器 人 的 驱动 装置 由 电动 机 和 行星 齿轮 减速 堪 构成 ， 其 
三 维 实体 造 ee， 











a) b) 
图 3-6 ”新 型 轮 腿 式 机 器 人 腿 部 的 三 维 实体 模型 
a) 腿 部 整体 模型 b) 足 部 模型 
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图 3-7 新 型 轮 腿 式 机 各 人 腿 部 实物 图 
(4) 驱动 它 置 造型 





图 3-8 机 器 人 由 “ 卧 ” 到 “站 ” 足 部 受 力 图 
新 型 轮 腿 式 机 器 人 的 驱动 装置 由 电动 机 和 行星 齿轮 减速 器 构成 ， 其 
三 维 实体 造型 如 图 3-9 所 示 。 
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图 3-9 ”驱动 装置 三 维 实体 造型 
a) GP 42C 行星 齿轮 尺寸 b) EC 45 盘 式 电动 机 尺寸 
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@3 
图 3-9 ”驱动 装置 三 维 实体 造型 ( 续 
c) 电动 机 + 减速 器 模型 
ee 当 所 有 和 零 部 件 的 建 模 都 完成 之 后 ， 则 对 新 型 轮 腿 式 机 问 人 的 整体 模型 进 
行 组 装 。 对 于 二 要 用 螺栓 固定 的 零件 ， 均 采用 刚性 连接 类 型 ， 如 最 体 的 侧 板 与 连接 板 之 间 、 
成 速 器 与 电动 机 之 问 等 等 ;对 于 只 有 一 个 旋转 目 由 度 的 零件 ， 采 用 销 名 连接 方式 。 各 种 连接 头 


型 及 其 自由 上 度 见 表 3-1。 

















与 目 由 度 相 关 的 约束 


刚性 连接 是 将 两 个 零件 连接 在 一 起 , 它 的 旋 可 采用 任何 一 种 约束 , 通 
转 目 由 度 和 平移 目 由 度 都 为 零 ， 属 于 完全 的 约 | 过 由 多 个 约束 构成 ， 完 成 后 
束 ， 受 刚性 连接 约束 的 零件 构成 单一 主体 零件 一 定 是 完全 约束 


绕 轴 旋转 ,旋转 自由 度 为 1, 平移 自由 度 为 有 
0， 构 件 只 能 绕 固定 的 轴 旋 转 轴 对 齐 和 平面 对 齐 /匹配 


沿 轴 / 边 平移 。 构 件 只 能 沿 直 线 方向 平移 ， 
改 其 平移 目 由 度 为 1， 旋 转 上 自由 度 为 0， 该 直 轴线 对 齐 和 平面 对 齐 / 由 配 
线 是 指定 的 轴 或 边 


沿 指 定 轴 平移 并 绕 该 轴 旋 转 。 旋 转 和 平移 ee 
| 由 度 分 别 为 1 轴线 对 齐 


通过 平面 接头 连接 的 主体 在 一 个 平面 内 相 
对 运动 。 故 平面 连接 总 和 目 由 上 度 为 3， 其 中 旋转 平面 与 平面 对 齐 /匹配 
目 由 度 为 1， 平移 目 由 度 为 2 


在 任何 方向 上 旋转 、 其 旋转 自由 度 为 3, 平 
点 与 点 大 
移 自由 度 为 0 en 


将 两 个 主体 粘 在 一 起 。 构 件 的 自由 度 为 0， 
类 似 于 刚性 连接 坐标 系 对 章 


看 成 组 合 球形 接头 及 滑 块 接头 。 构 件 可 以 在 
3 个 轴 疝 任意 旋转 ， 同 时 也 可 以 沿 指定 方向 平 点 与 轴线 对 齐 
移 ， 故 其 旋转 目 由 度 为 3， 平 移 目 由 度 为 1 


常规 连接 自由 度 可 以 由 用 户 自己 选择 ， 自 
出 度 数目 可 以 根据 实际 需要 选择 合适 的 约束 
和 ww | ww | ，，， | 来 得 到 。 某 些 常 规 连接 的 自由 度数 与 其 他 连 。 | 匹配、 对齐、 插入 、 毕 标 
0 2 ww 接 类 型 〈 例 如 球 、 圆 柱 或 销 ) 的 自由 度数 相 “| 系 、 线 上 点 、 曲 面 上 点 、 则 
同 。 常 见 常 规 连接 后 ， 系 统 将 放置 一 个 可 显 | 面 上 边 
示 其 自由 度 的 图 标 。 该 图 标 是 一 个 使 用 平移 
和 旋转 箭头 指示 自由 度 的 坐标 系 
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( 续 ) 


在 任何 方向 上 平移 及 旋转 , 具有 3 个 旋转 自 
由 度 和 3 个 平移 自由 度 ,可 用 6 自由 度 连 接 本 
型 ,具有 3 根 旋转 运动 轴 和 3 根 平 移 运动 轴 的 
6 自由 度 3 3 | 连接 。 该 接头 不 影响 模型 元 件 之 间 的 相对 运 “ | 。 坐标 系 对 章 
动 ， 因 为 没有 应 用 任何 约束 。6 自由 度 连 接 可 
以 用 作 应 用 伺服 电动 机 或 建 模 任何 所 需 类 型 
接头 的 位 轩 
展 连 接 是 两 个 主体 之 问 的 一 个 点 与 曲线 连 
搂 。 从 动 件 上 的 一 个 点 始终 在 主动 件 上 的 一 根 
曲线 (3D) 上 运动 。 模 连接 只 使 两 个 主体 按 所 | pw 
人 ! 上 | 指定 的 要 求 运动 ,不 检查 两 个 主体 之 间 是 否 二 ee 
涉 , 点 和 曲线 可 以 是 零件 实体 以 外 的 基准 点 和 
基准 曲线 ， 也 可 以 在 实体 内 部 


经 过 装配 ， 新 型 轮 腿 式 机 需 人 的 整体 模型 如 图 3-10 所 示 。 机 右 人 驱 体 两 侧 各 有 三 条 腿 ， 呈 
对 称 分 布 ， 中 间 腿 的 安 疙 位 置 比 二 后 腿 部 外 突 一 段 距离 ， 在 减 小 机 体 前 后 端 横 癌 结构 尺寸 的 同 
时 ， 可 有 效 避 免 前 、 中 、 后 三 条 腿 乙 间 的 互相 干涉 ， 使 机 器 人 的 运动 步 态 组 合 更 为 方便 。 


fl 
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图 3-10 新 型 轮 腿 式 机 器 人 的 整体 模型 
3.3.2 ”机 器 人 步 态 分 析 


1. 三 角 步 态 的 概念 

从 1877 年 返 布 里 奇 用 连续 摄影 方法 研究 动物 的 行走 开始 ， 人 们 对 步行 机 构 的 步 态 进行 了 
大 量 的 研究 工作 ， 尤 其 是 近 二 三 十 年 来 ， 关 于 步 态 研 究 的 重要 成 末 不 断 涌现 。 在 20 世纪 60 
年 代 末 ， 由 于 开发 步行 机 器 人 的 需要 ，Mc Ghee 在 总 结 前 人 对 动物 步 态 研究 成 果 的 基础 上 ,， 比 
较 系 统 地 给 出 了 关于 步 态 的 一 系列 描述 方法 和 分 析 步 态 的 严格 数学 定义 ， 为 步 态 的 研究 分 析 
砍 定 了 较为 完整 的 数学 基础 。 步 态 是 步行 机 器 人 的 一 种 迈步 方式 ， 是 步行 机 右 人 各 腿 协 调运 
行 的 规律 ， 即 各 腿 的 拾 腿 和 放 腿 顺序 ， 它 是 研究 步行 机 构 的 一 个 很 重要 的 参数 ， 是 确保 步行 
机 构 稳 定 运行 的 非常 重要 的 因素 。 

“六 是 网 ”昆虫 〈 晤 螂 、 曲 蚊 等 ) 在 平坦 无 阻 的 地 面 上 快速 行进 时 ， 多 以 交 登 的 三 角 步 态 运 
动 ， 即 在 步行 时 把 六 足 分 为 两 组 ， 以 且 体 一 侧 的 前 足 、 后 足 与 已 一 侧 的 中 足 作为 一 组 ， 形 成 一 个 
稳定 的 三 角 染 支撑 映 体 ， 如 图 3-11 所 示 。 因 此 在 同一 时 间 内 只 有 一 组 的 三 足 起 行走 作用 : 前 足 用 
爪 固定 物体 后 拉动 吴 体 前 进 ， 中 足 用 以 文 撑 并 举 起 所 属 一 侧 的 身体 ， 后 足 则 推动 号 体 前 进 ， 同 时 
使 身体 园 问 ， 行 走时 号 体 癌 前 并 稍 癌 外 转 ， 三 足 同 时 行动 ， 然 后 再 与 另 一 组 的 三 足 交 玲 进 行 ， 两 
组 是 如 此 区 蕉 地 摆动 和 支撑 ， 从 而 实现 昆虫 的 快速 运动 ， 其 行走 的 轨迹 线 是 一 条 锯 次 状 曲 线 。 
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2. 机 器 人 起 动 步 态 分 析 
当 痢 型 轮 腿 式 机 器 人 从 “ 卧 ” 到 “站 ”时 ， 如 图 3-12 所 示 ， 机 器 人 的 六 条 腿 同 时 运转 ， 
市 动机 体 区 服 重 力 做 功 。 这 时 每 个 腿 部 张 动 电动 机 所 需 转 矩 为 
(3-1) 
式 中 ”Gnax 为 机 器 人 的 最 大 重量 ，r 为 轮 腿 半径 ，h 为 电动 机 轴 距 箱 压 抵 部 的 距离 。 
从 建立 的 数学 模型 推导 可 知 ， 直 形 足 部 与 狐 形 足 部 在 电动 机 的 驱动 功率 上 近似 ， 因 此 为 
计算 方便 起 见 ， 在 这 里 及 后 续 计算 中 不 考虑 弧 形 足 部 的 问题 ， 均 采用 直 杆 结构 进行 计算 。 





图 3-11 暗 时 三角 步 态 图 图 3-12 ”新 型 轮 腿 式 机 器 人 从 “ 卧 ” 到 “站 ”示意 网 


3. 机 器 人 直线 行走 步 态 分 析 

(1) 慢 速 前 进 ”如 图 3-13 所 示 ， 当 新 型 轮 腿 式 机 器 人 行进 速度 较 慢 时 ， 机 喘 始 终 保 持 有 
一 组 腿 看 地 ， 此 时 机 里 重心 成 波浪 形 上 下 起 估 ， 振 动 较 大 ,但 由 于 电动 机 在 低 转 速 时 具有 较 
大 的 转 矩 ， 因 而 可 以 借助 腿 部 的 文 撑 越 过 一 定 的 垂直 高 度 。 由 图 3-13 可 知 ， 腿 每 转 90” 时 ， 
机 禹 人 的 器 步 距离 为 














rr 160 





= a en = 226.27mm (3-2) 
> 
式 中 一 轮 腿 的 半径， 这 里 为 160mm。 
而 机 体 下 降 的 高 度 为 
有 | 3 _ 
h =r(—sin45°)160x J mm = 46.86mm (3-3) 





(2) 快速 前 进 ” 假设 机 体 在 整个 运动 过 程 中 至 少 有 一 组 腿 独 地 ， 由 前 进 速度 v=3m/s， 可 
得 腿 旋 转 的 角速度 为 
中 = 二 =3/10.16rad =18.75rad (3-4) 
矿 


腿 的 旋转 周期 为 





2x 2x3.14 
a = 
0 18.75 
因此 腿 旋 转 4$” 所 用 的 时 间 为 
本 45°7 45°x0.335 


一 = 一 一 一 S=0.042S (3-6) 
360° 360° 


s=0.335s (3-5) 
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在 紧 直 方 同 上 ， 存 在 一 个 垂直 加 速度 ， 则 在 竖 直 方向 有 


岂 -2 -了 x9.8x(0.0427 =8.6x10~ (mm) (3-7) 





各 要 满足 新 型 轮 腿 式 机 器 人 在 整个 运动 过 程 中 全 少 有 一 组 腿 看 地 ， 则 需 满 足 广 =， 根据 
上 上 述 计 算 结 果 ， 显 然 等 式 是 人 不成立 的 ，hp<<h 加 ， 因 此 假设 人 不成立， 新 型 轮 腿 式 机 絮 人 在 快速 前 
进 时 存在 腾空 阶段 ， 在 这 段 时 间 内 ， 机 需 人 做 抛物 运动 ， 如 图 3-14 所 示 ， 机 占 人 其 有 类 似 于 
轮 却 机 需 人 的 快速 移动 能 

















图 3-13 ”机 右 人 慢 速 前 进 示 意图 图 3-14 机 右 人 快速 前 进 示意图 


4. 机 器 人 转弯 步 态 分 析 

(1) 行进 中 转 歼 ”对 于 在 行进 中 的 新 型 轮 腿 式 机 占 人 ， 要 改变 其 运动 方 辐 ， 只 需要 调 市 
各 电动 机 的 转速 即 可 。 机 堪 人 行进 中 转弯 的 示意 网 如 图 3-15 所 示 。 转 过时， 将 内 侧 电动 机 的 
转速 降低 ， 外 侧 电动 机 的 转速 增 大 ， 通 过 机 器 人 内 外 两 侧 的 速度 兰 来 实现 转弯 的 功能 。 


内 侧 低 转速 








NS 


(2) 原 地 转弯 ”首先 对 仿生 六 足 机 器 人 的 原 地 转弯 步 态 进行 分 析 ， 不 同步 态 时 刻 机 器 人 
各 点 位 置 矢量 如 图 3-16 所 示 。 其 运动 步 态 具体 为 : 

1) 如 图 3-16a 所 示 ， 机 器 人 6 条 腿 都 着 地 ， 设 为 初始 位 置 。 

2) 如 图 3-16b 所 示 ， 机 器 人 B1、B; 腿 旋转 y 角度 ( 设 旋转 y 角度 后 腿 部 在 x 轴 上 的 投影 

















Rs 
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3) 如 图 3-16c 所 示 ， 机 器 人 B 组 腿 作 支 撑 腿 ，4 组 腿 抬 起 。 


4) 如 图 3-16d 所 示 ， 机 器 人 B 组 腿 作 文 撑 腿 ，4 组 腿 抬 起 ， 做 


姿态 调 


新 型 轮 腿 式 机 器 人 


5) 如 图 3-16e 所 示 ，A4 组 腿 和 B 组 腿 均 沙 地 ， eg ed 





a) 





PA2=[ 


PB1=[ 


PB3=[ 


P41=[- (Lt+m) n 0T 


TH 0 Or 


P43=[- (L+m) —n 0O]T 


Li+m nn Olr 


PPB2=[- (Li+m) 0 Or 


Li+im —n 0 


PA1=[ — (L+m) n 
PA»=[ L+m 0 
P43=[ — (L+m) —n 
PB]1=[ L+m nt+Lsiny 
PB»=[ — (Li+m) — Lsiny 
PB3=[ Li+m 一 (n-Lsiny) 
PA1=[— (L+m) n 
P4)=[ Litm 0 
PA3=[— (Lt+m) 一 7 
PBI=[ 7ZHA n+Lsiny 
PB»=[— (Li+m) —Lsiny 
PB3=[ Li+m — (n-Lsiny) 
PA=[- (Ltm) n-Lsiny 
PA=[ Ltm Lsiny 
PA.=[— (Ltm) 一 (ntLsiny) 
PB =[ Lt+m n +Lsiny 
PB=I- (Ltm) -Lsiny 
PB=| Li+im — (n-Lsin) 
PA=[- (Ltm) n-Lsiny 
PA~L L+m Lsiny 
PA=[— (Lt+m) — (ntLsiny) 
PB =[ Li+m n +Lsiny 
PB=[— (L+m) 一 Zsiny 
PB=[ Li+im — (n-Lsiny) 


图 3-16 六 足 机 颖 人 原 地 转 要 步 态 图 


OT 
OJ]T 
OT 
hlT 
A]T 
hlT 


hjT 
hl]T 
hj]T 
OjT 
0]T 
0jT 


hj 
hj 
hj 
0j7 
0j7 
0j7 


0j7 
0j7 
0j7 
0j7 
0j7 
0j7 
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浙 型 轮 腿 式 机 器 人 的 工作 原理 与 仿生 六 足 机 器 人 大 
同 小 异 ， 参 照 以 上 仿生 六 足 机 器 人 的 原 地 转弯 步 态 ， 下 
面 分 析 新 型 轮 腿 式 机 器 人 的 原 地 转弯 步 态 。 对 新 型 轮 腿 
式 机 器 人 的 各 腿 进行 编号 ， 如 图 3-17 所 示 。 

机 器 人 初始 状态 为 六 条 腿 均 处 于 支撑 相 。 以 左 转 为 
例 ， 假 设 4 组 腿 ( 腿 1、 腿 3、 腿 5) 仍 处 于 支撑 状态 ， 
8 组 腿 ( 腿 2、 腿 4、 推 6) 为 摆动 相 。 对 于 摆动 相 的 腿 ， 
旋转 方向 内 侧 的 电动 机 ( 腿 2) 反 转 ， 外 侧 的 电动 机 ( 腿 
4、 腿 6) 正 转 。 当 摆动 相 的 腿 〈B 组 腿 》 快 接触 到 地 面 
时 ， 支 撑 相 的 腿 4 组 腿 ) 开始 摆动 ， 旋 转 方向 内 侧 的 
电动 机 ( 腿 1、 腿 3) 反 转 ， 外 侧 的 电动 机 ( 腿 5) 正 转 。 几 3 1 新 碍 NI 本 人 各 大 全 
在 这 个 瞬间 ， 完 成 支撑 相 (4 组 腿 ) 与 摆动 相 (8 组 腿 ) 

的 互 换 ， 同 时 实现 机 器 人 的 转向 。 当 机 器 人 右 转 时 ， 则 与 上 述 情况 刚好 相反 。 

除了 上 述 转弯 方式 之 外 ， 该 机 器 人 还 能 实现 其 他 多 种 旋转 变化 。 同 样 以 左 转 为 例 ， 不 过 
此 时 改 为 组 腿 ( 腿 2、 腿 4、 腿 6) 为 支撑 相 ，4 组 腿 ( 腿 1、 腿 3、 腿 5) 为 摆动 相 。 摆 动 
的 过 程 与 上 述 过 程 相 类 似 ， 唯 一 不 同 的 就 是 所 旋转 的 角度 。 另 外 ， 若 机 体 最 初 处 于 “平和 ” 
状态 ， 要 实现 转弯 的 功能 ， 机 器 人 不 必 先 站 立 起 来 进行 类 似 上 述 的 操作 ， 完 全 可 以 在 四 姿 的 
状态 下 完成 方向 的 改变 。 仍 以 左 转 为 例 ， 相 对 于 旋转 方向 内 侧 的 前 腿 ( 腿 1) 和 中 腿 ( 腿 2) 
反 向 旋转 ， 剩 下 的 腿 腿 3、 腿 4、 腿 5、 腿 6) 正 向 旋转 ， 直 到 机 体 再 次 平 躺 在 地 上 。 这 种 
旋转 方式 虽然 电动 机 的 负担 比较 大 ， 但 却 能 实现 大 角度 的 旋转 。 


3.3.3 ”机 器 人 控制 系统 设计 


1. 硬件 设计 

便 件 系统 由 移动 式 控 制 平台 、 骨 入 式 分 布控 制 系统 和 多 传 感 费 信息 融合 系统 组 成 。 

移动 式 控制 平台 由 工业 PC、 无线 数据 传输 模块 、 控 制 占 等 便 件 组 成 ， 作 为 人 机 交互 便 件 
平台 。 骨 入 式 控制 系统 采用 了 基于 CAN 总 线 的 移入 式 分 布 系 统 方案 ， 安 置 在 机 体内 部 ， 由 主 
空心 片 STM32 和 电动 机 Elmo 驱动 器 两 部 分 组 成 ,多 传感器 信息 融合 系统 采用 基于 Cortex-M3 
核心 的 数据 采集 单元 ， 实 时 采集 电动 机 运动 信息 、GPS、 超 声波 传感器 、 红 外 探测 器 及 能 源 状 
态 信 息 ， 在 艇 入 式 控制 系统 中 综合 处 理 。 

机 器 人 数据 通信 平台 采用 2.4GHz 的 ISM 频段 , 采用 ARM 为 主体 的 星 型 拓扑 结构 ， 并 搭 
载 惯性 制导 仪 等 。 机 器 人 的 视觉 信息 则 通过 1.2GHz 通信 频段 传递 ， 以 避免 2.4GHz 移动 通信 
频段 的 拥挤 所 导致 的 图 像 失 真 。 机 器 人 整体 便 件 原理 框图 如 网 3-18 所 示 。 

2. 软件 设计 

控制 系统 软件 是 控制 系统 的 核心 ， 它 主要 完成 调度 、 协 调 系统 各 个 便 件 模块 的 工作 ， 实 
现 信息 整合 、 任 务 分配 、 运 动 党 理 等 功能 。 欣 制 软 件 系统 由 机 载 系统 软件 和 总 探 平台 软件 两 
大 部 分 组 成 。 

忌 控 平台 软件 运行 于 便携 式 计算 机 中 ， 主 要 由 运动 行为 规划 模块 、 视 频 显 示 模 块 、 实 时 
数字 图 像 处 理 模块 、 人 机 接口 模块 和 串口 通信 模块 组 成 。 软 件 玉 用 Visual C++6.0 在 Windows 
XP 系统 下 开发 完成 。 总 探 平 台 的 人 机 交互 界面 如 图 3-19 所 示 。 

























































































第 3 章 ”新 型 轮 腿 式 机 器 人 





机 载 系 统 软件 以 陪 入 式 实时 多 任务 操作 系统 Linux 为 开 及 平谷 ,采用 面 丫 对象 的 多 线程 纲 
程 技术 开发 完成 ， 编 程 语言 为 C++。 分 别 建立 运动 控制 、 数 据 采 集 、 串 行 通信 等 对 象 ， 各 对 
象 内 建立 相对 独立 的 运行 线程 ， 协 作 完成 机 载 系统 各 部 分 任务 。 












2.4GHz 无 线 
数据 传输 模块 


-= HexRobot 


机 器 人 视觉 显示 视觉 控制 


“Conmected” 





“Wideo 0pen” 
“Standing Gait Ready” 
“Adopted Tripod Gaid” 


“Auto Searching” 


加 中 
ED 


“Target had been found” 


“Target i in the left 
side” 





“Begin to close” 


“Stopped” 


记 
计 
S 


TT 


处 理 后 图 漠 运动 控制 








图 3-19 ”人 机 交互 界面 


3. 主动 跟踪 模型 建立 与 算法 实现 
(1) 基于 Camshift 算法 的 目标 识别 与 跟踪 Camshift 算法 就 是 将 Meanshift 算法 扩展 到 连 
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续 图 像 序 列 。 它 将 视频 的 所 有 帧 进行 Meanshift 运算 ， 并 将 上 一 帧 的 结果 ， 即 搜索 窗 的 大 小 和 
中 心 作为 下 一 帧 Meanshift 算法 搜索 窗 的 初始 值 。 如 此 迭代 下 去 ， 就 可 以 实现 对 日 标的 跟踪 。 

Camshift 利用 目标 的 颜色 直方 图 模型 将 图 像 转 换 为 颜色 概率 分 布 图 , 初始 化 一 个 搜索 窗 的 
大 小 和 位 置 ， 并 根据 上 一 帧 得 到 的 结果 目 适 应 调整 搜索 窗口 的 位 置 和 大 小 ， 从 而 定位 出 当前 
图 像 中 目标 的 中 心 位 置 。 

经 过 视频 采集 卡 的 模 数 转换 ， 目 标的 RGB 彩色 空间 对 光照 腕 度 变化 较为 敏感 ， 为 减少 此 
变化 对 光照 的 影响 ,利用 HSYV 空间 瑟 分 量 在 不 同 照度 下 差 寞 不 大 的 特点 ， 通 过 目标 图 像 生成 
闫 色 概 京 合 找 表 ， 将 图 像 中 每 个 像 双 的 值 用 其 颜色 出 现 的 概 京 对 蕉 换 ， 得 到 闫 色 概 率 分 布 图 。 
这 个 过 程 称 为 反问 投影 , 此 时 颜色 概率 分 布 图 是 一 个 灰 度 图 像 ,， 然后 通过 Meanshift 算法 迭代 ， 
寻找 概率 分 布 的 极 值 来 定位 目标 。 

对 于 目标 图 像 Kaist (xz，?y7) ， 和 去 阶 距 为 



































4 一 >》 >》 Toviect (x 》 y) (3-8) 
x y 
一 阶 距 为 
Mo 二 > >》 xloviect (x 》 y) 
X Jy (3-9) 
Mo 二 > > yloviect (x 》 y) 
x y 
搜索 窗 的 质心 为 
x =M,/M, y=M,/M, (3-10) 





此 外 Camshift 算法 能 有 效 解 决 目标 变形 和 扩 挡 的 问题 ， 对 系统 资源 要 求 不 高 ， 时 间 复 杂 
度 低 ， 在 简单 背景 下 能 够 取得 良好 的 跟踪 效果 。 

(2) 主动 跟踪 模型 建立 ”由 于 新 型 轮 腿 式 机 器 人 体积 小 巧 ， 因 此 可 忽略 机 器 人 旋转 主轴 
和 PTZ 摄像 头 旋转 主轴 的 位 移 差 ， 三 维 模型 如 图 3-20 所 示 。 








图 3-20 忽略 位 移 差 后 的 三 维 模型 








采用 一 种 基于 迭代 思想 的 积分 算法 完成 主动 跟踪 功能 ， 机 右 人 与 镜头 夹 角 的 关系 如 下 : 


© 
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[wat, -|w.dt, =0 
加, = kg,300°/s (3-11) 
Ww, = pg,300°/s 
通过 Camshift 算法 实时 计算 出 目标 在 图 像 中 的 坐标 , PTZ 报 像 头 水 平方 同 视 场 角 为 65”， 
通过 Oiorizontat=65” (xz-320) /640 可 以 实时 生成 &， 再 调用 友 代 算法 计算 出 最 优 po， 所 的 解 ， 
从 而 达到 基于 目标 识别 的 实时 主动 跟踪 算法 ， 其 演示 如 图 3-21 所 示 。 











图 Histogr a 图 回回 








辐 回国 











图 3-21 实时 跟踪 算法 演示 


4. 驱动 电动 机 的 计算 与 选 型 
(1) 基本 参数 的 确定 ”机 器 人 的 总 体重 量 为 
G=meg =15x9.8N =147N (3-12 ) 

新 型 轮 腿 式 机 器 人 是 在 原 有 二 代 样 机 的 基础 上 通过 改进 设计 而 成 的 ， 采 用 已 经 优化 过 的 
机 体外 形 尺 寸 ， 如 图 3-22a 所 示 。 机 器 人 长 490mm， 宽 270mm， 高 150mm。 由 于 机 器 人 各 腿 
呈 左 右 对 称 分 布 ， 因 此 要 求 每 边 的 驱动 电动 机 〈 包 括 相 应 的 减速 器 等 元 器 件 ) 的 总 体 长 度 不 
能 超过 135mm。 如 图 3-22b 所 示 ， 电 动机 轴 距 箱底 底部 的 距离 h=50mmo。 

新 型 轮 腿 式 机 器 人 的 工作 环境 复杂 (沼泽 、 章 地 、 沙 石 、 软 泥 等 ), 摩擦 因数 确定 为 /=0.5。 

















高 =150mm 


长 =490mm 


党 =270mm 





a) 
图 3-22 机 器 人 箱 体 尺寸 


(2) 卧 姿 到 站 姿 转 矩 分 机 对 狐 型 轮 腿 式 机 需 人 起 动 瞬 间 的 受 力 分 析 如 图 3-23 所 示 〈 由 
于 健 杆 结构 的 腿 计 算 复 杂 ， 这 里 选用 直 杆 结构 的 腿 进行 计算 )。 
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图 3-23 ”新型 轮 腿 式 机 占 人 起 动 瞬间 的 受 力 分 析 


机 占 人 起 动 时 ， 六 条 腿 同 时 运转 ， 文 撑 映 体 从 “四 ”的 状态 到 “站 立 ” 状 态 。 因 此 每 条 
腿 所 受 的 文 持 力 为 


则 起 动 时 所 需 的 转 答 为 
T=FNr -hh =24.3SxV1602 -50°N.m=3.72N.m (3-14) 





(3) 站 姿 到 前 进 运动 瞬时 转 窍 分 析 ” 受 力 分 析 如 图 3-24 所 示 《 和 采用 三 角 步 态 ， 忽 略 摆动 
相 的 腿 )。 
对 坐标 系 z 轴 取 转 矩 : 





fs Cos — fsinQatficos0 7 +/sinGa — fscos0. 6 丰 =0 (3-15) 
对 坐标 系 y 轴 取 转 知 : 
FE-- 有 h int fsingr ES+L)]-/ sinQ.r =0 (3-16) 


对 坐标 系 x 轴 取 转 矩 : 
Fa— fcosQr—Fa— fcosOr— fcosQr=0 (3=17) 
由 力 的 平衡 原理 ， 在 z 轴 方 向 有 : 


Ft+E+t+F=G (3-18) 

在 y 轴 方 问 : 
ficosQ + ficosO + fscosQ =0 (3-19) 

在 x 轴 方 问 : 
fsinQ+ fisinQ +f:snQ=0 (3-20) 
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式 中 (i 二 1，3，5) 一 一 各 腿 所 受到 的 文 持 力 (N); 
矿 CE=1，3，5) 一 一 各 腿 所 受到 的 摩 探 力 ， 且 及 =AF (N); 
/一 一 腿 的 旋转 半径 (mm); 
0 (i 二 1，3，5) 一 一 摩擦 力 与 -Y 轴 方 回 的 角度 ， 且 有 一 180° 硅 0 硅 180°; 
s 一 一 机 体 的 宽度 ，s=270mm; 
a 一 一 轴 与 轴 之 间 的 中 心 距 ，a=200mm; 
[一 一 中 间 腿 突出 机 体 的 距离 ，L=50mm。 





图 3-24 ”由 站 姿 到 前 进 的 机 器 人 受 力 分 析 
将 式 (3-19) 代入 式 (3-17)， 得 


200(F —F)—160(ficosQ@ + ficosQ +f:cosQ)=0 (3-21) 
he (902) 
Ha (3 180 30 0320 BL. (3°5227 MEAT (03519), 1 
135CF +F)—160(fsinQ + fisinG + fsinQ.)—180F =0 (3523) 
270F -180 到 =0 人 
270F —180x(47-2F)=0 (3-25) 


求 得 
Fi=E=432N, F=63N 
将 所 、 互 、Fs 的 值 代 入 式 《3-15)、 式 (3-19)、 式 〈3-20)， 化 简 得 
2835 〈cosO +cosO)+4200 (sinQ —sin QO)—5670c0s0,.=0 
coSO +cosO =—1.5cosh. (3-26) 
sin0 +sinQ, =—1.5sinO. 
解 式 “3-26) 可 得 
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0 =131.41° {6 =48.59° 
0, =48.59。 或 10, =134.41° 
0., =90° 0., =—90° 
此 时 最 大 转 算 为 : 
T=fcos0 =0.5x42x0.66x160=2.22(N.m) (3-27) 
(4) 机 颖 人 人 匀速 前 进 转 和 沧 分 析 ”从 前 面 的 步 态 分 析 一 市 中 我 们 了 解 到 ， 新 型 轮 腿 式 机 器 
人 以 3m/s 的 运动 速度 快速 前 进 时 ， 机 体会 有 一 段 时 间 处 于 腾空 状态 。 在 这 段 时 间 内 ， 机 体 做 
抛物 运动 。 下 和 面 ， 将 对 这 种 情况 下 十 要 的 电动 机 转 滤 进行 计算 。 
假设 经 过 时 间 上 后 ， 腿 旋转 了 办 新 型 轮 腿 式 机 左 人 重新 洛 于 地 面 ， 则 有 























5 eg 弓 =7G-Ssin 内 (3-28 ) 
] To 
= 3-29 
引证 纪 r(l — sin@) ( ) 


2 
Le 百 志 | =160xd -sinf) (3-30) 
180 18.75 
解 得 

pf = 88.83° 
匀速 前 进 时 机 堪 人 受 力 分 析 示 意图 如 图 3-25 所 示 。 








图 3-25 ” 色 速 前 进 时 机 堪 人 受 力 分 析 示 意图 


对 坐标 系 z 轴 取 转 窃 : 


ficost -fsinOa-reosW+ jicosb + fisinOa trcost) — 
(3-31) 
fscos0. +] + fssinOrcos@=0 
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对 坐标 系 》 轴 取 转 外 
广 — fssinOrsing+rF > — fisinOrsinf—F G 十 可 — fsinO.rsin@=0 (3-32) 


对 坐标 系 x 轴 取 转 和 矩 : 
F(a—rcost)— fscosOrsinf— F(at+rcos@)— ficosOrsing— 


Fsrcos@— fscosOrsinO@=0 ee 
由 力 的 平衡 原理 ， 在 z 轴 方 向 有 : 
ftst+fs=0 (3-34) 
在 》 轴 方 崔 : 
ficosQ + ficosQO + fscosQ =0 (3-35) 
在 x 轴 方 问 : 
fsnQ+ fisinO +fssinQ.=0 (3-36) 
33) MUANE (03320 有 
135CF +E)=180F. (3-37) 
将 式 “3-34) 代入 式 (3-33)， 得 
196.73F —203.27F —3.27F; =0 (3-38) 


联 立 式 (3-37)、 式 (3-38)， 解 得 
=40.8N, fF3=43.2N, Fs=63N 

将 让，F3，F; 的 值 代入 式 (3-31)、 式 (3-34)、 式 《3-35)， 化 简 得 

2910cos 山 +2734cosO —4320sin0, +4080sin0@ -3070cos 丰 =0 

40.8cosO +43.2cosQ +63cosO =0 (3-39) 

40.8SInO + 43.2siIn OQ +63sin0, =0 
解 式 (3-39) 可 得 

cosO =+0.617 或 土 0.591 


cosQ, = 十 0.648 或 +0.719 (3-40) 
cosQ. = +0.03 
机 器 人 匀速 前 进 时 对 应 的 转 矩 为 
T=Frcos@+ ficosOrsn@ (i=1, 3, 5) (3-41) 


由 此 可 分 别 算出 3 条 腿 的 最 大 转 算 
T=234N:m, T=2.63N:m, T=0.357N:m 
办 此 在 匀速 前 进 时 ， 机 上 右 人 腿 部 所 需 的 最 大 转 失 为 
T=T =2.63N:m 
(5) 机 器 人 电动 机 选 型 ”由 前 面 的 计算 可 知 各 运动 姿态 下 狐 型 轮 腿 式 机 器 人 腿 部 所 宕 的 


© 
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最 大 转 矩 。 鉴于 机 器 人 在 刚 起 动 及 疏 坡 过 程 中 需要 较 大 的 转 矩 来 实现 运动 , 根据 公式 P=7@， 
当 功率 一 定时 ， 角 速度 越 小 ， 转 矩 越 大 。 因 此 在 起 动 及 疏 坡 时 ， 机 器 人 将 降低 电动 机 转速 来 
获取 较 大 转 矩 。 
经 以 上 分 析 ， 对 于 电动 机 的 计算 ， 只 考虑 该 机 器 人 在 匀速 平地 上 运行 的 情况 。 根 据 前 面 
的 计算 结果 ， 在 机 器 人 以 3m/s 的 速度 匀速 前 进 时 ， 腿 部 所 需要 的 最 大 转 算 为 .63Nm， 考 虑 
新 型 轮 腿 式 机 器 人 工作 环境 复杂 ， 需 要 在 多 种 恶劣 场合 进行 作业 ， 因 此 考虑 较 大 的 电动 机 裕 
度 系数 =3.5， 以 防止 电动 机 因 堵 转 而 烧 坏 。 
根据 公式 P=7w， 求 出 电动 机 的 功率 为 
P=7@=2.63x18.7 SW =49.3122W (3-42) 
电动 机 最 大 连续 转 矩 为 
7 ， =7x4=2.03x3.3SN.m=9.203N.m (3-43) 


选择 Maxon 的 EC 45 系列 盘 式 电动 机 作为 驱动 元 件 ， 并 选择 与 之 匹配 的 行星 齿轮 减速 右 
GP 42C。 考 尾 到 所 设计 的 新 型 轮 腿 式 机 右 人 定位 精度 要 求 不 襄 ， 为 了 市 省 箱 体 内 的 空间 ， 减 
轻 机 间 人 总 体质 量 ， 这 里 不 使 用 编码 莫 。 

GP 42C 行星 齿轮 减速 名 输出 的 最 大 连续 转 宅 为 13N'm>9.205Nm， 电 动机 + 行星 齿轮 
减速 甫 的 总 长 为 91.2 mm<135 mm, 因此 满足 设计 要 求 。 电 动机 与 减速 名 具体 参数 如 图 3-26 
所 示 。 























iotor order number 
EC 45 flat, 50WwA brushless, 1 Shaf end, Ball bearings 


hin. Nominal 





Nominal voltage 18 Wd ”| 
No-load speed 6173 B710 rd rpm ”| 
No-load current 294 441 mA Md 

Rated speed 5250 rpm ”| 
Rated torque (max. continuous torque) 96.9 mm ”| 
Rated current (max. continuous current) 3.54 所 "| 
Stall torque 935 1100 1260 jmNm ”| 
hlax. efficiency 84.5 号 ”| 
Terminal resistance (phase to phase) 0.384 0.413 0.442 IOhm Md 

Terminal inductance (tphase to phase) 0.258 [ee 0.386 ImH ”| 
Torque constant 23.1 25.1 27.1 JImNm/A -| 
Speed constant 350 380 410 rpmiy ”| 
Speed-tordue gradient 4.99 6.24 ?7.49 romimNm ”| 
Mechanical time constant 8.82 ms ”| 
Rotor inertia 122 135 149 |gcm??? 国 ”| 
Therm. resistance housing-ambient 4.25 KAN ”| 
Therm. resistance winding-housing 4.5 KiVY ”| 
Therm. time constant winding 16.6 S ”| 
Therm. time constant stator 212 S ”| 
Ambient temperature range -40 25 100 | 阁 ”| 
hlax. winding temperature 125 辣 ”| 
Max. Speed 10000 rpm M4 

viotorwelgdht 110 日 "| 

a) 





Gear order number 


GP 4d2 C, Gear reduction ratio 113:1, Preloaded ball bearings 





Gear reduction ratio 113 |:1 v 
Gear reduction absolute Wl:1 M 
Gear efficiency 72 |% v 
Max. continuous gear torque 15 INm MG 
Short-term torque 22.5 INm ”| 
Max. gear input speed 3000 |rpm MG 
Gear mass inettia 9.4 |9cm??? 镍 ~ 
No of stages 3 |- "| 
b) 


图 3-26 电动 机 与 减速 右上 基体 参 数 


a) EC45 檀 式 电动 机 -339285 参数 b) GP 42C 行星 齿轮 -203126 参数 
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| n [rpm] "| 辕 ‘Scale motor 
I¥ VWorking points 
160 4 


厂 Max. contin. torque motor (a) 


厂 Contin. current (b) 
厂 Max. current (ce) 
lv Max. voltage (d) 


矿 Dutput power (e) 
Efficiency 多 
厂 winding temperature (yg) 


厂 Max. contin. torque gear (th) 
厂 Max. torque gear i 
厂 Max. speed gear (k) 








maxon drive Unit 

Gear 203126 GP 42C Gear reduction ratio 113:1, Preloaded ball bearings 
viotor 339285 EC 45 flat 50Ww, brushless, 1 Shaft end, Ball bearings 
Control 





Key data of drive 


Awailable motor voltage GE= Umot) 4 
No-load speed (at Umot) 158 lpm | 
Load stall torque (theoretic, at Umot) 239 INm | 
Starting current (theoretic, at Urmot) 116 
Diameter 5 Imm | 
Length 912 Imm ”| 
Ambient temperature (=Tamb) 25 | 阁 


Cc) 


图 3-26 ”电动 机 与 减速 右上 基体 参数 〈 续 ) 
c) 电动 机 + 减速 器 总 体 参数 





3.3.4 ”机 器 人 运动 仿真 与 样机 实验 
1. 机 器 人 3D Max 虚拟 仿真 


当 在 Pro/E 中 建 模 完成 后 , 打开 “文件 ”一 “保存 副本 ”。 在 “保存 副本 ”对 话 框 中 选择 
导出 的 路 径 并 对 名 称 进 行 修 改 ,， 在 “类 型 ”选项 中 按 下 拉 篆 头 ， 将 其 保存 为 3D Max 可 以 打开 
的 文件 类 型 ， 如 STL、OBJ 每 。 本 设计 采用 OBJ 格式 导出 , 在 弹出 的 对 话 框 中 ,， 单 击 “ 添 加 ” 





按钮 ， 再 选择 零件 的 坐标 系 ， 单 击 “ 确 定 ” 按 钮 将 文件 导出 。 
打开 Autodesk 3D Max 9 局 动 按 钮 ， 进 入 操作 界面 ， 如 图 3-27 所 示 。 


一 项 目 文 件 夫 : C:\Documents and Settings\cait\y Documen ts\ 3dsnar 





文件 对) 仿 带 伍 ) 工具 { 红 ) 奶 苞 ) 视图 创 尘 亿 ) de re 


Be 
项 


a 























>| 
[TTTT | Ba | 0 TT Ea | TT iTT TT TT TTT HT TIT _ 
未 地 定 任 8 图 了 了 二 = 10.0 ee >| :wel mE wee: 尽 男 可 田 
| 单 击 或 单 击 并 失 动 以 选择 对 象 | 设 轩 关键 点 | 引 荡 | 六 直 沪 图 





3-27 3D Max Peer 
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选择 “文件 ”一 “导入 ”， 查找 之 前 Pro/E 导出 的 文件 地 址 ,同时 在 文件 类 型 中 选择 之 前 
导出 的 文件 类 型 。 单 击 “ 确 定 ”按钮 后 ， 会 弹出 一 个 导入 器 对 话 框 如 图 3-28 所 示 ， 单 击 “ 确 
定 ” 按 钮 导入 零件 。 


柱 单个 I 六 这个 局 ) fw 证 转 模 型 外 ) 

厂 辅助 对 入 HM 厂 组 坟 ) | Y 魏 理 坐标 六 ) 

蕊 克 法 线 徊 | 克 闹 一 疝 
让 择 委 导 网 的 虹 克 对 得 平滑 组 必 ) 

d | 平 诊 组 名): [i 一 
顶点 比 语 局) [Lo 一 
「 中 心 轩 总 ) 


材质 选项 

lv 使 用 材质 由) 
柯 质 库 
全 部 | 无 | 5 于 | | 


职 消 











图 3-28 ”导入 器 对 话 框 


在 零件 导入 以 后 ， 如 图 3-29a 所 示 ， 曲 面 上 会 有 很 多 棱 边 ， 要 使 零件 看 起 来 更 平滑 ， 可 
以 按 以 下 步骤 进行 设置 : 中 选择 零件 ， 单 击 界 面 右 侧 的 “修改 ”按钮 ;， 包 在 “修改 器 列表 ” 
中 选择 “平滑 ”;，@@ 复 选 平 滑 参 数 栏 中 的 “ 目 动 平滑 ”。 经 过 设置 之 后 ， 零 件 表 面 变 得 平滑 
了 许多 ， 如 图 3-29b 所 示 。 

透视 








图 3-29 “平滑 ”修改 对 比 图 
a) 修改 前 b) 修改 后 
修改 完 零 件 后 ， 按 快捷 键 F9， 可 以 看 到 演 染 的 效 来 图 ， 如 图 3-30a 所 示 ， 此 时 发 现 零件 
会 有 缺损 的 情况 。 下 面 对 零 件 进行 再 次 修改 : 
1) 选择 零件 ， 鬼 快捷 键 M， 打 开 材 质 编辑 器 。 
2) 在 “明暗 喜 基 本 参数 ” 栏 中 复 选 “ 双 面 ” 噬 弄 面 


四 





3) 单 击 旭 按钮 ， 将 编辑 好 的 材质 指定 给 选 定 对 和 象 。 











再 次 按 快 捷 键 F9， 可 以 看 到 请 染 后 的 零件 不 再 有 缺损 的 现象 ， 如 网 3-30b 所 示 。 不 过 由 

零件 的 材质 改变 了 了 ， 颜 色 也 发 生 了 变化 ， 因 此 在 将 材质 指定 给 对 象 前 ， 要 先 对 材质 的 颜色 

或 图 和 案 进 行 编 辑 ， 但 这 样 一 来 ， 每 导入 一 个 零件 都 需要 对 材质 进行 编辑 ， 非 党 烦琐 。 下 面 介 
绍 一 种 更 快捷 的 方法 来 解决 修改 零件 的 “缺损 ”问题 。 
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1) 选择 亲 早 栏 中 的 “ 演 染 ”一 “ 洽 染 场景 ”， 或 者 按 快 捷 键 F10; 

2) 打开 “ 演 染 场景 ”窗口 ， 在 “选项 ” 栏 中 复 选 “ 强 制 双 面 ”; 

3) 单 击 “ 演 染 场景 ”窗口 右 下 角 的 “ 演 染 ”按钮 。 

在 弹出 的 “ 演 染 ”窗口 中 发 现 零件 不 再 缺损 ， 如 网 3-30c 所 示 。 演 染 效 末 同 前 一 种 方法 ， 
不 过 这 种 方法 不 需要 对 每 个 稚 件 进行 编辑 ， 效 京 更 珊 。 
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图 3-30 ”零件 演 染 效果 图 
在 导入 零件 后 ， 可 以 通过 “选择 并 平移 ”按钮 或 “选择 并 旋转 ”对 零件 进行 移动 或 旋转 ， 
对 于 要 求 精 确定 位 ， 可 以 在 平移 按钮 或 旋转 按钮 上 单 击 右键 ， 在 弹出 的 窗口 栏 中 对 零件 的 坐 
标 进 行 编辑 ， 如 图 3-31 所 示 。 








a) b) 
图 3-31 零件 平移 或 旋转 的 窗口 栏 
a) 移动 变换 输入 b) 旋转 变换 输入 
因 篇 幅 有 限 ， 在 这 里 惑 不 对 所 有 零件 的 动画 制作 过 程 进 行 说 明 。 下 面 给 出 使 用 3ds Max 





制作 动画 的 儿 扣 经 验 。 

1) 当 用 户 在 制作 动画 的 过 程 中 需要 改变 零件 初始 位 置 ， 必 须 在 关闭 “设置 关键 点 ”按钮 
的 情况 下 《 亦 即 该 按钮 成 灰色 状态 ) 对 零件 进行 编辑 。 大 用 户 在 “设置 关键 点 ”按钮 开局 〈 这 
时 投 钮 成 红色 状态 ) 的 状态 下 对 零件 进行 编辑 ， 即 使 设置 了 关键 点 ， 在 播放 动画 的 过 程 中 零 
件 将 出 错 ， 侦 离 预 想 的 位 置 。 

2) 在 动画 制作 过 程 中 ， 可 多 按 几 次 Gew， 设 首 好 关键 点 。 不 然 ， 当 移动 到 其 他 帧 时 ， 原 
本 设置 好 的 动作 在 未 保存 的 情况 下 将 丢失 ， 用 户 则 需要 再 次 对 动画 进行 编辑 。 

3) 在 做 动画 的 过 程 中 ， 对 同 组 或 同系 统 的 零件 可 创建 “ 集 ”， 如 将 本 作品 中 的 电动 机 和 
减速 右 设 置 为 一 个 “电动 机 组 ”的 集 ， 将 连接 电动 机 与 侧 板 的 虹 色 设置 为 一 个 集 。 当 到 后 期 
有 许多 零件 时 ,如 不 需要 在 “ 按 和 名称 选 择 对 象 ”中 一 个 一 个 碍 找 , 可 以 直接 在 “命名 选择 集 ” 
中 选择 需要 的 对 象 。 

图 3-32 为 儿 个 制作 动画 时 的 时 刻 视角 。 
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c) d) 
图 3-32 ”新 型 轮 腿 式 机 器 人 3D Max 动画 


为 了 规划 新 型 轮 腿 式 机 器 人 在 采用 三 角 步 态 运动 时 各 腿 间 的 相互 关系 ， 利 用 3ds Max 对 
机 器 人 执行 三 角 步 态 时 各 腿 间 的 相互 关系 进行 模拟 仿真 ， 以 确定 正确 的 运动 参数 ， 其 步 态 模 
拟 如 图 3-33 所 示 。 图 3-34 为 各 腿 转 角 期 望 值 与 实际 值 拟 合 图 。 
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图 3-33 ”新 型 轮 腿 式 机 器 人 三 角 步 态 模拟 图 3-34 各 腿 转角 期 望 值 与 实际 值 拟 合 图 





2. 机 器 人 样机 实验 
为 验证 前 面 理论 分 析 与 虚拟 仿真 的 正确 性 ， 对 新 型 轮 腿 式 机 器 人 样机 进行 运动 步 态 实验 ， 
包括 起 动 步 态 、 三 角 步 态 等 ， 实 验 情 况 如 图 3-35 所 示 。 实 验 结果 证 明 新 型 轮 腿 式 机 器 人 能 够 
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完成 起 六、 行进 等 多 项 运动 ， 达 到 了 运动 速率 和 灵活 性 的 协调 统一 。 此 外 ， 配 合 多 传 感 带 信 
县 融合 技术 和 数字 疼 像 处 理 技术 ， 新 型 轮 腿 却 机 需 人 能 够 可 笔 、 稳 定 地 实现 目 主 避 障 和 特种 


侦 碍 等 功能 。 








3-35 ”新 型 轮 腿 式 机 器 人 起 动 步 态 及 三 角 步 态 的 实现 





主要 创新 点 及 取得 的 成 果 


3.4.1 ”作品 主要 创新 点 


作品 主要 创新 点 如 下 : 

1) 新 型 轮 腿 式 机 右 人 阅 上 共 腿 式 机 副 人 地 形 适应 性 强 和 轮 式 机 寓 人 机 动 速度 局 的 优点 ， 与 
辣 级 地 面 机 器 人 相 比 ， 访 机 右 人 拥有 极 强 的 越野 行驶 能 力 ， 可 在 复杂 地 形 条 件 下 局 效 运动 ， 
且 具 有 一 定 的 两 栖 运 动能 力 。 

2) 机 需 人 控制 系统 采用 分 层 递 阶 的 体系 结构 ， 遥 控 与 目 主 控制 相 络 合 ， 可 根据 作业 任务 
的 复杂 程度 采用 不 同 的 控制 方式 。 

3) 采用 先进 的 多 轴 伺 服 运 动 控制 技术 ， 其 备 多 种 运动 模式 ， 可 根据 地 形 条 件 目 主 选择 运 
动 方式 ， 保 证 了 机 磊 人 在 复杂 地 形 情 况 下 局 速 运动 时 的 稳定 性 。 

4) 基于 多 线程 技术 和 和 藤 入 式 技术 开 肥 实现 了 目 主 探测 、 目 动 退 踪 和 目 主 避 障 功能 。 

5) 操作 人 员 可 根据 任务 需求 和 地 形 条 件 姑 活 选用 每 个 关节 北 置 的 腿 节 数量 ， 改 变 机 旧 人 
运动 性 能 和 机 动 特性 。 
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3.4.2 ”作品 取得 的 成 果 


作品 取得 的 成 果 如 下 : 

1) 新 型 弱 腿 式 机 器 人 原理 样机 1 台 。 

2) 新 型 轮 腿 式 机 器 人 研究 技术 报告 1 份 。 

3) 获得 国家 外 观 专利 1 项 : 小 型 轮 腿 机 器 人 。 

4) 公开 发 表 新 型 轮 腿 式 机 器 人 相关 学 术 论 文 1 篇 ， 同 时 被 EI 收录。 

5) 获得 第 三 届 全 国 大 学 生 创新 年 会 “我 最 喜爱 的 十 件 作 品 ” 称 号 ， 排 名 第 五 。 


忆 结 与 展望 


仿生 机 器 人 在 恶劣 的 环境 下 往往 能 担当 重要 的 角色 ， 成 为 当今 科学 研究 领域 中 的 一 大 
热点 。 项 目 组 在 借鉴 当今 国内 外 仿生 蝉 蛙 机 右 人 结构 设计 及 工作 原理 的 基础 上 ， 通 过 对 原 
有 二 代 轮 腿 式 机 器 人 进行 改 民 ,设计 并 研制 出 了 一 种 狐 型 小 尺寸 、 轻 体重 、 多 用 途 的 轮 腿 
式 机 堪 人 。 充 机 器 人 集中 了 腿 式 机 器 人 地 形 适 应 性 串 和 轮 式 机 器 人 机 动 速度 高 的 优点 ， 可 
在 复杂 地 形 条 件 下 以 多 种 行进 步 态 和 多 种 运动 方式 完成 特殊 的 任务 。 本 研究 主要 完成 的 工 
作 如 下 : 

1) 根据 国内 外 相关 资料 ， 对 狐 型 轮 腿 式 机 器 人 的 整体 结构 进行 了 分 析 ， 并 制订 出 了 相应 
的 设计 方案 。 运 用 Pro/E 三 维 造 型 软件 对 机 器 人 的 所 有 零 部 件 进 行 了 建 模 , 在 完成 建 模 工 作 后 ， 
运用 Pro/E 软件 的 仿真 功 能 进行 了 念 丰 操 作 ,， 确定 了 各 和 零 部 件 的 安装 位 置 ， 大 大 提高 了 产品 的 
设计 效 识 和 准确 性 。 

2) 在 对 狐 型 轮 腿 式 机 器 人 的 功能 特点 和 运动 要 求 进行 评 尽 分 析 的 基础 上 ， 结 合 仿 生 学 原 
理 ， 对 机 器 人 的 运动 步 态 进 行 了 分 析 ， 包 括 起 动 步 态 、 和 直线 行 走 步 态 和 转 芍 步 态 。 

3) 开 发 了 狐 型 轮 腿 式 机 器 人 的 上 位 机 人 机 交互 系统 和 基于 ARM 的 散 入 式 运 动 控 制 系统 ， 
探索 了 多 轴 体 服 运 动 控 制 技 术 ， 在 控制 、 反 饿 各 环节 之 间 及 机 器 人 视觉 系统 中 采用 无 线 数 据 
通信 方式 ， 实 现 了 机 器 人 的 远程 帝 探 ， 并 辅助 以 超声 波 探 测 堪 阵列 ， 以 及 多 传 感 右 信息 融合 
技术 和 数字 网 像 处 理 技 术 ， 实 现 了 新 型 轮 腿 式 机 需 人 的 三 角 步 态 运 动 和 目 主 避 隐 探测 的 主体 
功能 。 

4) 在 ProE 三 维 实体 模型 的 基础 上 ， 运 用 3ds Max 软件 为 新 型 轮 腿 式 机 器 人 做 了 动画 渗 
*。 通 过 动画 的 演示 过 程 ， 可 对 新 型 轮 腿 式 机 器 人 的 结构 、 装 配 过 程 及 各 种 步 态 有 清晰 的 了 
符 。 通 过 虚拟 仿真 和 样机 实验 ， 验 证 了 新 型 轮 腿 式 机 器 人 具有 民 好 的 越野 行驶 能 力 和 稳定 可 
靠 的 控制 性 能 。 

由 于 研究 时 间 有 限 ， 新 型 轮 腿 式 机 器 人 仍 存在 许多 有 竺 进一步 研究 的 地 方 ， 对 后 续 工 作 
提出 以 下 建议 。 

1) 对 机 器 人 的 腿 部 结构 进行 动力 学 分 析 ， 研 究 各 参数 对 机 器 人 整体 性 能 的 影响 ， 并 对 腿 
部 进行 优化 设计 ， 确 定 腿 部 的 最 优 尺 寸 。 

2) 对 机 器 人 疏 坡 、 翻 越 隐 碍 等 进行 实验 分 机， 了 解 在 各 种 运动 情况 下 电动 机 的 参数 变化 ， 
并 描绘 出 相应 曲线 示意 图 ， 为 以 后 的 研究 设计 提供 参考 。 
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(第 四 局 全 国 大 学 生 创新 年 会 “我 最 喜爱 的 10 个 项 目 ”， 
排名 第 一 ，2011 年 ) 


[两 和 作品 研究 的 青 景 儿 意义 


仿生 机 器 人 的 设计 是 一 项 具有 技术 挑战 性 而 又 富有 设计 创 狐 性 的 高 科技 含量 、 多 技术 综合 的 
科学 探索 工作 和 技术 实现 活动 。 束 目前 已 有 的 各 种 仿生 机 器 人 而 言 ， 腿 式 机 器 人 在 上 共有 地 形 适 应 
性 强 的 优点 同时 ， 也 存在 运动 速度 慢 ， 机 体 平 衔 控 制 困 难 的 不 足 ， 轮 陈 机 器 人 机 动 速度 快 ， 但 跨 
越 障 碍 、 适 应 不 同 地 形 和 机 里 灵活 运动 的 能 力 各 有 欠缺。 鉴于 目前 的 仿生 机 上 右 人 研究 在 仿生 效果 、 
能 源 消耗 、 实 际 用 途 、 科 技 应 用 每 各 方面 仍 存 在 很 大 的 研究 空间 ， 因 此 在 仿生 研究 的 基础 上 ， 保 
留 机 器 本 号 的 轮 式 运动 的 同时 结合 生物 腿 式 运动 的 特点 ， 设 计 一 球 同 时 拥有 轮 式 快速 运动 和 腿 式 
适应 性 强 特点 的 万 肢 型 机 右 人 是 一 项 有 很 蝇 研 究 价 值 和 广阔 应 用 前 景 的 工作 。 当 前 国外 市 肢 型 念 
生机 器 人 研究 领域 中 ， 最 具 代 表 性 的 是 日 本 和 干 叶 理工 学 院 设计 的 Halluc I 型 八 足 机 器 人 ， 它 具有 
较为 突出 的 轮 式 与 腿 式 相 结 合 的 运动 能 力 。 国 内 在 轮 式 、 腿 式 功 能 结合 的 轮 腿 式 机 右 人 领域 已 经 
开展 了 研究 和 探索 ， 并 取得 了 众多 成 果 ， 但 在 具有 极 强 的 轮 腿 复合 运动 能 力 、 高 度 绽 合 轮 式 与 腿 
式 机 器 人 特点 的 仿生 贡 胶 型 机 器 人 领域 尚未 实现 重大 突破 。 

针对 上 述 问 题 ， 本 项 目 立 足 于 仿生 学 ， 以 机 械 结 构 设 计 、 多 电动 机 协调 控制 技术 、 步 态 规划 
技术 、 传 感 通信 技术 、 软 件 程序 开 友 技术 等 关键 技术 为 突破 点 ， 完 成 狐 型 节肢 机 器 人 设计 研发 工 
作 ， 所 设计 的 新 型 节 股 式 机 器 人 (New Arthropod Robot，NAR) 应 具备 以 下 特点 : 

1) 行进 步 态 多 ， 结 合 抽 象 仿生 学 的 原理 ， 在 结构 和 步 态 设计 上 有 机 结合 了 昆虫 仆 行 姿态 
和 轮 式 机 械 行进 的 特点 ， 使 得 狐 型 节 股 机 器 人 在 控制 系统 的 统 宕 下 ， 根 据 机 器 人 视觉 采集 的 
环境 信息 ， 分 别 采 取 昆 虫 的 多 足 爬 行 、 蟒 蟹 的 横 癌 侧 行 、 仿 人 的 腿 陈 行走 、 凡 陈 的 镍 镜 六 进 、 
机 车 的 轮 式 深 动 等 多 种 行进 步 态 。 

2) 适应 性 强 ， 采 用 多 关节 、 多 伺服 驱动 的 租 入 式 分 布控 制 系统 ， 稳 定 控 制 40 个 电动 机 ， 
实现 多 种 运动 模式 、 多 种 运动 姿态 的 完美 结合 ， 可 适应 结构 化 或 非 结 构 化 应 用 环境 ， 有 具备 一 
机 多 能 特点 ， 且 环境 信息 采集 齐全 ， 能 在 复杂 的 地 形 条 件 下 执行 多 重 探 测 任务 。 

3) 控制 方式 互补 ， 应 用 无 线 数 据 通 信 技 术 构 成 狐 型 市 股 机 器 人 视 沉 系统 ， 实 现 了 机 器 人 
的 远程 中 探 ， 采 用 分 层 递 阶 的 控制 体系 结构 ， 实 现 机 体 目 主 控制 ， 从 而 使 得 远程 中 探 和 日 主 
控制 相 结 合 ， 可 根据 执行 任务 的 复杂 程度 采用 不 同 的 控制 方式 ， 你 证 机 右 人 其 有 超 强 的 运动 
功能 和 众多 的 动作 方式 。 

4) 集成 上 度 高 ， 兼 具体 积 小 巧 、 机 动 灵 活 、 复 杂 地 形 适 应 能 力 强 、 目 动 平衡 能 力 强 、 控 制 
稳定 的 特点 ;能 依靠 腿 的 协调 动作 来 保持 机 吴平 稳 ， 弥 补 轮 式 机 器 人 不 能 适应 复杂 地 形 的 不 
足 ; 还 可 和 赁 借 轮 的 统一 驱动 控制 来 提高 整 机 的 行进 速度 ， 实 现 腿 式 机 需 人 的 快速 行进 ， 真 正 























































































































实现 仿生 学 研究 中 多 种 生物 运动 方式 的 集成 优化 。 


作品 概述 





4.2.1 研究 内 容 概述 


1. 机 器 人 总 体 设 计 

新 型 节肢 机 器 人 总 体 结构 如 图 4-1 所 示 ， 机 器 人 由 电源 模块 、 处 理 控制 核心 、 运 动 控 
制 核 心 、 电 动机 驱动 与 电动 机 模块 、 反 人 馈 和 传 感 占 模块 、 无 线 模 块 和 上 位 机 模块 等 功能 模 
块 组 成 。 

(1) 电源 模块 ”电源 模块 用 于 为 新 型 节肢 机 器 人 处 理 控制 核心 模块 、 运 动 控 制 模 块 、 传 
感 器 检测 模块 、 电 动机 模块 等 各 功能 模块 提供 电流 。 由 于 新 型 节 胶 机 器 人 中 共有 8 个 直流 有 
刷 电 动机 和 32 个 直流 角 位 移 伺服 电动 机 ， 以 及 1 片 ARM 人 微 处 理 嚣 心 片 ，1 片 Freescale 
MC9S12XS128 单片机 心 族 ,4 厂 L298N 电动 机 张 动人 世族 和 无 线 模 块 ， 所 以 新 型 节 胶 机 器 人 的 
总 耗 电量 很 大 ， 需 要 根据 实际 实验 及 计算 结果 选择 合适 的 电源 ， 并 做 好 过 流 保护 电路 。 

(2) 处 理 控制 核心 ”处理 控制 核心 是 新 型 节 觅 机 器 人 的 “神经 中 槐 ” 接受 加 速度 传感器 、 
超声 波 传感器 、 摄 像 头 的 环境 检测 信号 ， 经 过 处 理 ， 通 过 无 线 通信 发 送 给 上 位 机 ， 并 能 够 接 
受 上 位 机 的 无 线 控制 命令 ， 使 机 器 人 执行 命令 操作 。 同 时 ， 处 理 控 制 核心 能 够 自主 的 控制 机 
髓 人 的 步 态 变换 等 运动 控制 ， 是 机 器 人 信息 汇总 中 心 。 

(3) 运动 控制 核心 ”运动 控制 核心 是 新 型 节肢 机 器 人 的 “运动 中 枢 ”， 主 要 用 于 产生 控制 
直流 有 刷 电 动机 和 直流 角 位 移 伺 服 电动 机 的 PWM 波形 信号 , 接受 上 一 层 处 理 控 制 核 心 的 步 态 
和 行进 方 癌 的 控制 信号 ， 给 下 一 级 的 直流 有 刷 电 动机 的 驱动 模块 和 直流 角 位 移 伺服 电动 机 控 
制 信号 ， 从 而 使 机 器 人 进行 各 种 步 态 变换 和 行进 方 癌 的 转弯 ， 是 整个 机 器 人 运动 控制 的 核心 
所 在 。 
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图 4-1 新 型 丰 及 机 器 人 总 体 结构 


(4) 电动 机 张 动 与 电动 机 模块 ”电动 机 驳 动 模块 主要 是 针对 8 个 直流 有 刷 电 动机 的 张 动 ， 
而 32 个 直流 角 位 移 伺 服 电动 机 其 内 部 有 目 带 的 张 动 模块 ， 不 需要 在 机 器 人 中 马 外 添加 驱动 模 
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块 。 电 动机 驱动 模块 主要 用 于 为 下 流 有 刷 电 动机 的 转动 提供 电流 ， 从 而 使 电动 机 能 控 照 控制 
信 写 局 速 转动 。 电 动机 模块 包括 8 个 直流 有 刷 电 动机 和 32 个 直流 角 位 移 伺服 电动 机 ， 其 中 下 
流 有 刷 电 动机 用 于 新 型 节 胶 机 需 人 轮 式 滚动 时 作为 前 进 运 动 足 ， 直 流 角 位 移 伺 服 电动 机 能 根 
所 控制 信号 PWM 的 占 空 比 定位 在 需要 的 角度 ， 构 成 机 右 人 人 32 个 天 市 ， 是 控制 新 型 布 股 机 右 
人 运动 足 作 腿 却 前 进 或 是 轮 陈 前 进 方 辐 的 执行 机 构 。 

(5) 有 反馈 和 传 感 占 模块 ”新 型 而 上 肌 机 费 人 中 用 于 反馈 的 传 感 占 有 加 速度 传 感 上 融 ， 能 检测 
机 各 人 在 xyz 三 个 方 同 的 加 速度 ， 从 而 能 检 训 到 机 需 人 的 姿态 信息 ， 能 够 为 处 理 控制 核心 控制 
机 右 人 的 姿态 以 适应 各 种 地 形 提供 姿态 信息 。 狐 型 市 瞳 机 右 人 中 用 于 环境 检 测 和 视觉 系统 的 
传 感 占 为 超声 流传 感 占 和 摄像 尖 ， 其 中 超声 小传 感 占 能 够 测量 机 占 人 与 周围 障 丛 物 或 者 目标 
障 但 物 的 距离 ， 从 而 使 得 新 型 节 胶 机 器 人 具有 目 动 避 障 功能 和 目标 训 距 功能 ， 而 摄像 头 能 够 
转动 检测 机 右 人 前 方 180” 范 围 内 的 视频 网 像 信 息 ， 并 能 将 视频 图 像 信息 通过 无 线 通 信 传 输 给 
上 位 机 ， 用 于 进行 环 霸 其 调和 远程 遥控 。 

(6) 无 线 模块 和 上 位 机 模块 ”无 线 模 块 是 新 型 布 肌 机 右 人 处 理 控制 核心 与 上 位 机 进行 信 
县 交流 的 平台 ， 一 方面 能 把 机 器 人 的 传感器 检 训 的 环境 信息 传 给 上 位 机 进行 环境 监察 ， 万 一 
方面 能 够 将 上 位 机 的 控制 指令 传 给 机 堪 人 的 处 理 控 制 核心 ， 从 而 实现 远程 遥控 。 

2. 机 械 结构 设计 

独 型 丰 版 机 如 人 的 机 械 结构 设计 框图 如 图 4-2 所 示 。 


各 关节 连接 剧 设 计 曲 辟 设 计 轮 式 足 设计 


新 型 节 股 机 器 人 
机 械 结构 


图 4-2 机械 结构 设计 框图 


新 型 节肢 机 器 人 的 机 械 结构 由 主体 躯干 和 8 条 多 轴 运 动 腿 组 成 ， 其 中 运动 腿 沿 中 轴线 对 
称 分 配 在 主体 颈 干 两 侧 ， 构 成 左右 对 称 的 机 体 。 依 靠 运 动 足 的 独特 机 械 设 计 和 关节 布局 ， 使 
得 机 器 人 能 完成 几 十 种 运动 步 态 ， 并 能 跨越 一 定 高 度 的 障 得 物 。 因 此 ， 运 动 足 的 设计 是 这 个 
机 器 人 机 械 设 计 的 重点 工作 。 其 中 ， 各 运动 足 之 间 的 距离 间 隅 设计 ， 使 得 机 器 人 在 前 进 或 后 
退 时 的 步 长 和 运动 能 满足 设计 要 求 ， 不 至 于 运动 时 前 后 腿 相 冲突 ; 运动 足 各 关节 之 间 的 距离 
设计 ， 可 使 得 机 器 人 的 各 关节 能 在 预定 的 角度 范围 内 转动 ; 运动 足 足 底 滚 轮 的 斜率 设计 ， 可 
使 得 机 器 人 在 横 癌 侧 行 步 态 时 腿 部 等 曲 的 角度 恰好 使 深 轮 看 地 点 与 地 面相 切 。 同 时 ， 绪 干部 
分 作为 机 器 人 的 运动 足 主要 文 撑 和 连接 构件 ， 其 形状 和 强度 设计 也 是 很 重要 的 。 最 干部 分 与 
各 运动 足 的 连接 点 分 布 应 当 均 匀 ， 旦 和 驱 干 部 分 的 设计 还 关系 到 机 器 人 的 重力 分 布 和 各 部 分 的 
机 械 强 度 。 此 外 ， 新 型 节肢 机 器 人 的 外 观 工 业 设 计 是 展现 机 器 人 风采 和 特色 的 重要 方式 。 新 
型 节肢 机 器 人 实物 样机 如 图 4-3 所 示 。 
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图 4-3” 狐 型 厄 股 机 器 人 实物 样本 


3. 硬件 平台 设计 
便 件 电路 框图 如 图 4-4 所 示 。 





| 
| 
| | 蚀 电 池 电 源 电压 转换 模块 3.3V 控 制 器 电源 | 
| | 
| | 


最 小 系统 电路 


模块 接口 电路 


摄像 头 人 机 接口 
传 感 右 模块 ARM 控 制 板 电路 





图 4-4 使 件 电 路 框图 


新 型 节肢 机 器 人 的 硬件 电路 主要 包括 电源 电路 、 传 感 器 电路 、ARM 控制 板 电路 、XS128 
控制 电路 和 通信 模块 电路 。 其 中 由 于 锂电 池 电 压 一 般 为 3.7V 和 7.4V 等 ，ARM 心 厂 所 需 电压 
为 3.3V， 其 他 心 卢 一 般 都 为 SV， 上 所 以 在 电源 模块 中 应 当 包 括 为 各 心 族 供电 的 电压 转换 电路 ， 
而 且 机 器 人 中 电动 机 数量 较 多 ， 在 电源 模块 中 应 当 有 电源 的 过 流 保 护 措 施 。 便 件 平 台中 ARM 
控制 板 电路 是 新 型 节肢 机 器 人 的 硬件 控制 核心 ， 与 传感器 电路 、 电 动机 驱动 控制 电路 、 通 信 
模块 都 有 通信 接口 ， 是 硬件 电路 的 第 一 级 控制 电路 。XS128 控制 电路 是 关键 的 便 件 控制 中 心 ， 
所 有 电动 机 的 驱动 和 控制 、 反 馈 ! 信 号 都 在 此 人 硬件 电路 中 实现 。 此 外 ， 传 感 嚣 和 通信 模块 具有 
独立 的 便 件 电 足 模块 。 

4. 软件 平台 设计 


软件 平台 结构 框图 如 图 4-5 所 示 。 
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ARM 控 制 指令 
步 态 控制 输出 
转向 和 跨越 障碍 





图 4-5 软件 平台 结构 框图 


软件 平台 设计 主要 是 对 新 型 季 胶 机 器 人 的 两 个 控制 忌 片 即 处 理 控制 核心 心 片 ARM stm32 
和 运动 控制 核心 心 片 Freescale MC9S1 2XS128 的 软件 程序 编号 ， 以 及 无 线 通信 的 上 位 机 显示 
界面 与 控制 程序 编写 。 

在 软件 编程 过 程 中 ， 将 分 层 递 阶 的 控制 思想 映射 到 程序 中 ， 将 传感器 检测 信号 、 上 位 机 
控制 信号 、 机 器 人 总 体 运 动 状态 等 集中 于 处 理 控制 核心 的 软件 编程 ， 而 将 各 个 电动 机 的 驱动 、 
运动 步 态 和 方 癌 的 实现 集中 于 运动 控制 核心 的 软件 编程 ， 从 而 使 得 信息 处 理 与 运动 控制 在 一 
定 程度 上 相互 独立 而 又 彼此 相关 ， 控 制 思路 清晰 明了 。 上 位 机 程序 将 主要 用 来 显示 摄像 头 传 
这 的 环境 信息 ， 发 送 上 位 机 控制 指令 。 


4.2.2 ”技术 指标 


1) 长 三 0.60m， 守 夺 0.25m， 高 和 0.20m， 和 重量 夺 16kg。 

2) 平均 移动 速度 为 40m/mmin， 人 攀 越 障碍 最 大 高 度 0.1Sm。 

3) 视觉 传 感 占 采集 周边 环境 图 像 信 息 并 实时 传输 给 控制 中 心 ， 有 效 视 野 郊 围 为 8m。 

4) 可 根据 现场 实时 图 像 进行 无 线 操控 ， 有 效 无 线 通 信和 路 离 为 1.5km。 

5) 实现 昆虫 的 多 足 爬 行 、 螃 蟹 的 横 问 侧 行 、 仿 人 的 腿 式 行走 、 蛇 式 的 希 岛 前 进 、 机 车 的 
轮 式 滚动 五 种 主要 步 态 ， 及 其 他 辅助 步 态 。 

6) 控制 系统 能 对 40 个 电动 机 进行 稳定 的 控制 ， 欣 制 机 器 人 改变 运动 姿态 ， 以 及 实现 一 
定 的 探测 、 侦 凤 能力 。 


天 键 近 术 


4.3.1 ”结构 设计 技术 


新 型 节 胶 机 右 人 有 五 关 基 本 运动 方式 : 昆虫 的 多 足 谎 行 、 蚁 胡 的 横 问 侧 行 、 仿 人 的 腿 式 
行走 、 蛇 却 的 希 镜 前 进 、 机 车 的 轮 式 滚动 。 五 类 基本 运动 方式 中 每 一 类 都 包含 多 种 步 态 ， 并 
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可 对 基本 运动 方式 进行 组 合 ， 可 实现 复合 式 步 态 。 

为 实现 五 种 基本 步 态 的 互相 变化 和 保证 每 种 步 态 的 精确 性 和 流畅 性 ， 新 型 节 及 机 器 人 采 
用 了 少 有 的 8 是 设计 ， 而 不 是 常见 的 6 足 设计 。 通 过 步 态 规划 ， 将 使 靳 型 万 肌 机 右 人 在 任意 
时 刻 都 能 你 证 全 少 有 四 条 腿 与 地 面 接触 ， 从 而 大 大 地 增加 了 目 吴 稳定 性 ， 为 做 出 更 为 复杂 的 
步 态 动作 提供 了 稳定 性 的 你 证 。 

新 型 节 胶 机 器 人 虚拟 样机 结构 如 图 4-6 所 示 ， 其 八 个 运动 足 均 设置 为 五 目 由 度 ， 采 用 有 
有 四 个 转动 关节 、 一 个 作为 足 部 的 直流 电动 机 和 有 具有 特定 角度 的 曲 臂 结 构 的 独特 设计 ， 使 得 
运动 足 的 看 地 冰 能 在 其 可 达 域 的 三 维 空间 中 任意 位 置 沙 地 ， 便 于 控制 足 部 运动 。 为 了 达到 运 
动 要 求 ， 每 只 运动 足 上 有 4 个 大 角度 精 宅 转角 艇 机 和 1 个 高 精度 二 流体 服 电动 机 ， 全 身 共 40 
个 电动 机 使 新 型 节 肌 机 器 人 能 够 实现 最 大 40 目 由 度 的 同步 运动 ， 为 步 态 的 实现 提供 了 足够 的 
目 由 上 度 ， 同 时 通过 对 电动 机 的 精确 控制 可 以 使 新 型 节 股 机 占 人 的 步 态 更 加 的 晕 真 和 流畅 ， 实 
现 理 想 的 仿生 的 效 琳 。 

运动 足 自由 度 设 计 如 图 4-7 所 示 。 运 动 足 的 上 部 由 四 个 关节 组 成 ， 分 别 由 直流 角 位 移 伺 服 电 
动机 内 部 的 驱 动 模块 驱动 ， 构 成 了 新 型 节肢 机 费 人 主要 运动 结构 ， 运 动 呈 的 的 部 设置 为 一 台 朋 沉 
电动 机 ， 用 于 驶 动 轮 式 足 ， 使 机 体 获 得 轮 式 滚动 的 运动 方式 ， 安 姜 和 二流 电 动机 的 圆柱 形 结构 是 作 
为 运动 足 的 步行 足 端 部 ， 可 使 机 体 以 腿 式 步行 的 运动 方式 适应 多 种 不 同 的 地 形 环境 。 



























































图 4-6 新 型 节肢 机 器 人 虚拟 样机 结构 图 4-7 运动 足 自由 度 设计 
新 型 三 及 机 堪 人 的 主要 结构 参数 见 表 4 -1。 
表 4-1 新 型 节肢 机 器 人 的 主要 结构 参数 


全 长 640mm 
重量 13kg 
脚 数 8 
每 脚 电 动机 数 5 
最 大 翻越 障碍 物 高 度 0.15m 
最 大 疏 坡 角度 30° 
目 由 度 40 
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1. 主要 机 构 设 计 

(1) 伺服 电动 机 包围 结构 ”根据 伺服 电动 机 的 尺寸 大 小 (40.6mmx19.7mmx35.5mm)， 来 
确定 包围 结构 外 壳 的 尺寸 ， 并 通过 精细 的 测量 来 确定 背 板 上 和 伺服 电动 机 对 称 位 置 安装 轴 的 
位 置 ， 从 而 保证 了 对 称 性 。 此 外 ， 在 设计 时 两 侧 预 留 
出 了 0.1mm 的 安装 间 隐 ， 以 方便 调整 。 伺 服 电动 机 包 
围 结构 闭 配 图 如 图 4-8 所 示 。 

(2) 运动 足 曲 臂 的 设计 “运动 足 曲 臂 的 设计 是 脚 
部 结构 设计 的 难点 ， 需 要 综合 运动 学 、 动 力学 、 步 态 
规划 等 多 方面 因素 ， 并 需要 兼顾 外 观 设计 。 由 于 在 进 ， Hh 
行 结构 设计 之 前 ， 机 器 人 的 体型 参数 与 多 样 步 态 规划 .里 -MR 
的 要 求 决 定 了 机 器 人 腿 部 结构 的 第 二 与 第 三 关节 处 连 
杆 结构 设计 的 重要 性 。 该 连 杆 结构 的 设计 经 历 了 一 个 
有 反复 的 设计 过 程 。 起 初 ， 根 据 稻 机 参数 与 机 器 人 体型 
参数 指标 进行 精确 计算 后 ， 初 定 运动 足 为 直线 型 ， 长 
度 为 62.3mm。 为 了 设计 简单 起 见 ， 从 几何 角度 来 看 ， 国人 48 何 服 电动 机 包装 和 的 交 本国 
两 点 之 间 直 线 最 短 ， 因 此 采用 直线 型 连接 件 是 最 简单 易 行 的 解决 方案 。 出 于 提高 结构 刚度 的 
考虑 ， 必 须 在 两 三 运动 足 结 构件 之 间 添 加 辅助 加 强 板 。 在 通过 对 机 器 人 虚拟 样机 的 运动 学 仿 
真 以 后 ， 此 类 设计 由 于 辅助 加 强 板 的 存在 ， 限 制 了 第 三 关节 处 能 机 的 运动 空间 ， 可 能 在 实际 
运行 过 程 中 发 生 干 涉 。 因 此 ， 这 种 简单 的 结构 设计 不 利于 机 器 人 仿 人 腿 式 行走 步 态 的 实现 ， 
与 机 器 人 的 步 态 多 样 性 的 功能 要 求 背 道 而 驰 。 经 过 研究 ， 并 受到 人 体 腿 部 膝盖 关节 的 启发 ， 
确定 采用 曲 臂 形 式 。 根 据 运动 足 动作 的 设计 要 求 ， 曲 臂 由 两 部 分 组 成 ， 并 要 求 曲 臂 前 部 大 于 
32mm， 曲 臂 后 部 大 于 50mm， 两 轴 之 间距 离 大 于 60mm。 通 过 调整 尺寸 ， 使 曲 臂 这 曲 角度 为 
90”， 前 部 尺寸 3Smm， 后 部 尺寸 S2mm。 设 前 部 长 度 为 g&、 后 部 长 度 为 5、 两 轴 距 离 为 c， 由 
义 股 定理 c=Vo: + 刀 ，c=62.3mm>60mm， 满 足 设计 要 求 。 曲 臂 尺 寸 儿 何 关系 如 网 4-9 所 示 ， 
曲 辟 结构 如 图 4-10 所 示 。 
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a>32 
p>50 
c>60 
图 4-9 ” 曲 辟 尺寸 几何 关系 图 4-10” 曲 辟 结 构 











(3) 同 侧 两 运动 足 乙 间距 离 设计 ， 通 过 测量 可 得 最 展 端 第 五 关节 伺服 电动 机 轴 与 足 撒 站 
橡胶 底面 乙 间 的 距离 为 82.8mm， 而 由 运动 分 析 可 知 ， 运 动 足 要 能 够 绕 第 五 关节 伺服 电动 机 轴 
180” 旋 转 ， 因 此 ， 设 伺服 电动 机 轴 到 股 抵 距离 为 1 ， 两 足 之 间距 离 为 6， 且 1, >24 ， 因 此 根 
据 设 计 要 求 , 将 同 侧 两 运动 足 之 间距 离 设计 为 180mm， 使 得 两 足 能 够 同时 旋转 且 不 发 生 干 涉 。 
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足 部 直流 电动 机 结构 如 图 4-11 所 示 ， 两 足 之 间距 离 计算 如 图 4-12 所 示 。 








图 4-11 足 部 直流 电动 机 结构 图 4-12 ”两 足 之 间距 离 计 算 
(4) 轮 式 足 外 形 设 计 当 需 要 实现 腿 式 步 态 时 ， 需 要 令 足 部 直流 电动 机 绕 第 三 关节 轴 心 
旋转 抬 起 ， 为 保证 在 抬 起 过 程 中 转动 的 平稳 ， 需 要 将 轮 式 足 外 轮廓 曲线 与 以 第 三 关节 轴 心 为 
圆心 的 大 圆 相 切 。 通 过 计算 得 曲率 为 22mm。 轮 式 足 的 曲率 计算 如 图 4-13 所 示 。 


人 
.一 on 
一 Eee 




















图 4-13 ” 轮 式 足 的 曲率 计算 


2. 材料 选择 及 加 工 

通过 对 新 型 节肢 机 器 人 重量 的 总 体 估计 和 机 械 结 构 强 度 要 求 的 分 析 ， 在 对 各 种 机 械 材料 
进行 比较 选择 的 基础 上 ， 最 终 确定 采用 硬 铝 (LY12)〉 来 作为 主 结构 体 的 材料 。 

硬 铝 (LY12) 材料 主要 性 能 参数 : 密度 为 2.78g/cnY ， 抗 拉 强 度 0% 宇 425MPa， 条 件 届 服 强 
度 %%; 宇 275MPa。 该 合金 强度 局， 有 一 定 的 耐 热 性 ， 可 用 作 150C 以 下 的 工作 零件 ， 其 热 状 态 、 
退火 和 新 汉 火 状态 下 成 形 性 能 都 比较 好 ， 热 处 理 强 化 效果 显著 。 

加 工时 将 利用 数控 机 床 ， 通 过 UG 软件 将 Pro/E 软件 生成 的 .prt 文件 直接 导入 ， 生 成 加 工 
刀具 轨迹 ， 通 过 数控 机 床 的 车 、 铣 和 钻 孔 等 操作 来 对 材料 进行 加 工 。 将 对 整体 加 工 精度 提出 
较 高 要 求 ， 并 强调 细小 部 位 圆 角 的 加 工 精 度 。 精 度 要 求 为 : 连接 部 位 的 公差 为 IT7; 其 他 公差 
为 IT10; 除 特 殊 部 位 (轴承 连接 处 ) 表面 粗糙 度 为 6.3um。 

3. 问题 及 解决 方案 

1) 由 于 伺服 电动 机 不 是 标准 的 长 方 体 ， 而 是 梯形 体 ， 所 以 在 设计 外 壳 时 要 求 两 边 的 内 酸 尺 
寸 不 同 ， 但 是 外 壳 的 尺寸 要 相同 。 在 设计 时 ， 可 通过 对 外 壳 的 厚度 的 不 同 设计 来 解决 这 一 问题 。 

2) 由 于 新 型 节肢 机 器 人 的 机 械 结 构 均 采用 铝 合金 〈LY12)， 所 以 本 身 重 量 偏 大 。 为 减轻 
机 器 人 整体 的 重量 ， 在 保证 结构 强度 的 同时 ， 适 量 地 在 结构 件 上 设置 减 重 槽 可 解决 此 问题 。 
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经 实验 证 明 ， 通 过 此 方式 可 使 机 器 人 重量 减轻 30% 以 上 。 

3) 运动 足 撒 部 的 直流电 动机 部 分 与 轮 式 足 相 连接 ， 同 时 轮 陈 足 要 选用 摩 探 力 大 的 橡胶 材 
料 。 由 于 橡胶 容易 变形 ， 所 以 容易 导致 电动 机 与 轮 式 足 固 定 不 牢 徘 。 经 过 研究 与 讨论 ， 选 用 
金属 轮 心 加 橡胶 轮 套 的 方案 ， 既 能 你 证 和 流 电动 机 和 轮 式 足 连 接 的 牢 千 ， 又 能 保证 接触 地 面 
的 轮 式 足 有 足够 的 摩擦 力 。 


4.3.2 ”控制 系统 与 多 轴 和 运动 控制 近 林 


机 器 人 的 控制 系统 采用 分 层 递 阶 的 控制 体系 结构 ， 遥 挖 与 自主 控制 相 结 合 ， 可 根据 执行 
任务 的 复杂 程度 采用 不 同 的 控制 方式 ， 保 证 机 器 人 具有 极 强 的 运动 能 力 和 丰富 的 运动 方式 。 
在 多 电动 机 控制 技术 方面 ， 采 用 先进 的 多 轴 伺 服 运动 控制 技术 ， 直 流 电动 机 与 角 位 移 伺 服 电 
动机 相 结合 ， 协 调 一 致 的 工作 ， 保 障 机 器 人 圆满 实现 多 种 步 态 。 从 底层 搭建 控制 系统 ， 使 用 
新 型 蔡 入 式 系统 构架 方 法 , 针对 控制 系统 的 特点 , 以 采用 高 性 能 ARM Cortex-M3 内 核 的 STM32 
微 处 理 器 为 微 控 制 器 ， 以 飞 思 卡 尔 公 司 9S12XS128 芯片 为 运动 控制 核心 ， 实 现 对 多 伺服 器 的 
高 速 控制 ， 保 证 机 器 人 具有 突出 的 运动 性 能 。 

控制 系统 的 体系 结构 以 任务 为 目标 ， 以 协调 合作 为 核心 ， 采 用 意 法 半导体 公司 ARM 
Cortex-M3 内 核 的 STM32 微 处 理 占 ， 采 用 高 级 散 入 式 系统 设计 方法 ， 以 无 线 通 信和 为 纽带 ， 主 
要 包括 : 决策 层 、 通 信 层 、 协 调 层 和 执行 层 。 决 策 层 使 机 器 人 系统 具有 一 定 程 度 的 自主 性 ， 
可 将 外 部 环境 变化 或 操作 者 指令 所 引起 的 系统 内 部 啊 应 经 过 分 析 和 判断 ， 形 成 对 整个 机 器 人 
系统 的 控制 决策 ， 通 信 层 主要 负责 实施 实时 、 高 效 、 无 差错 地 与 控制 中 心 进行 通信 。 协 调 层 
是 对 所 执行 任务 进行 分 解 ， 并 对 任务 执行 情况 进行 反馈 。 执 行 层 通过 驱动 各 个 执行 部 件 来 实 
现 机 器 人 的 运动 和 动作 ， 从 而 准确 高 效 地 完成 动作 任务 及 探测 任务 等 。 控 制 系统 的 整体 框图 
如 图 4-14 所 示 。 新 型 节肢 机 器 人 的 硬件 构成 主要 包括 处 理 控制 核心 模块 、 运 动 控制 核心 模块 、 
电源 管理 模块 、 电 动机 驱动 模块 和 传感器 检测 模块 。 
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图 4-14 ”控制 系统 的 整体 框图 
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1， 控 制 模块 硬件 平台 

新 型 节肢 机 器 人 控制 系统 是 采用 以 ARM Cortex-M3 内 核 的 处 理 器 作为 中 央 处 理 单 
元 ， 以 Freescale16 位 单 厂 机 作为 运动 控制 单元 构架 的 多 MCU 散 入 式 系 统 。 机 器 人 控制 
系统 采用 先进 的 深层 舱 入 思想 ， 构 架 分 层 递 阶 式 的 新 型 控制 体系 ， 在 多 轴 体 服 控制 技术 
的 基础 上 ， 为 机 器 人 构架 专用 控制 核心 ， 从 硬件 底层 设计 开始 ， 硬 件 软件 相 结合 ， 构 架 
机 器 人 整体 模块 。 

(1) 处 理 控 制 核心 “采用 了 意 法 半导体 公司 的 STM32 F103。STM32 系列 基于 专 为 要 求 
高 性 能 、 低 成 本 、 低 功 耗 的 嵌入 式 应 用 设计 的 ARM Cortex-M3 内 核 ， 工 作 频 率 为 72MHz， 内 
置 高 速 存 储 器 (高 达 128KB 的 闪存 和 20KB 的 SRAM)， 丰 富 的 增强 IO 端口 和 连接 到 两 条 
APB 总 线 的 外 设 ， 拥 有 luns 的 双 12 位 ADC，4MPs 的 UART，18MPs 的 SPI，18MHz 的 VO 
翻转 速度 ， 集 成 了 复位 电路 、 低 电压 检测 、 调 压 器 、 精 确 的 RC 振荡 器 ， 并 含有 3 个 通用 16 
位 定时 器 和 一 个 PWM 定时 器 等 。 

STM32 有 如 下 特点 : 

1) 供电 电压 : 2 一 3.6V。 

2) 容忍 5V 的 IO 管 脚 。 

3) 优异 的 安全 时 钟 模式 。 

4) 带 唤 醒 功 能 的 低 功 耗 模式 。 

5) 内 部 RC 振荡 器 。 

6) 内 骸 复 位 电器。 

7) 工作 温度 范围 : -40 一 8SC 或 10SC 。 

由 于 机 器 人 控制 软件 系统 与 内 部 控制 算法 计算 是 基于 处 理 器 控制 核心 的 控制 周期 设计 
的 ， 因 此 ， 处 理 右 对 控制 周期 下 的 中 汤 处 理 能 力 将 决定 控制 系统 总 控制 性 能 ARM Cortex-M3 
处 理 器 内 置 航 套 的 向 量 式 中 断 控 制 右 ， 能 够 处 理 多 达 43 个 可 屏蔽 中 断 通 道 (不 包括 16 个 
Cortex-M3 的 中 断 线 ) 和 16 个 优先 级 ， 性 能 强大 的 中 断 系 统 能 够 满足 狐 型 方 股 机 器 人 控制 的 
实时 性 要 求 。 同 时 ，STM32 芯片 具有 高 速 的 通信 接口 以 实现 控制 核心 与 上 下 级 各 个 模块 的 无 
颖 连接 。 

STM 32 心 片 通信 接口 模块 图 如 图 4-15 所 示 。 其 中 USART 接口 是 机 器 人 与 下 位 机 通信 的 
输出 接口 ， 通 过 USART 控制 核心 将 计算 的 运动 步 态 控制 信息 传递 全 下 位 机 运动 控制 核心 ， 实 
现 115200 波 特 这 的 数据 传输 速度 。SPI 总 线 接口 是 机 器 人 与 集成 无 线 模 块 连接 的 输出 接口 ， 
通过 SPI 接口 控制 核心 癌 无 线 模块 传输 机 器 人 的 各 个 状态 信息 , 在 上 层 PC 控制 端 进行 机 器 人 
调试 与 参数 采集 。USB 接口 是 机 器 人 控制 核心 与 外 界 存储 介质 的 通信 接口 ， 通 过 机 器 人 与 存 
储 介质 的 联系 ， 实 现 大 量 数据 存储 分 机 ， 静 态 存 储 的 性 质 也 使 得 机 器 人 在 反 电 的 情况 下 也 能 
保存 重要 信息 ， 增 强 机 器 人 探测 侦查 能 力 。IC 与 CAN 总 线 是 工业 常用 的 控制 总 线 协 议 ， 可 
以 作为 机 器 人 折 展 部 分 保留 其 拓展 空间 。 

(2) 运动 控制 核心 “控制 系统 的 运动 控制 芯片 采用 发 思 卡 尔 公 司 的 9S12XS128 单片机 ， 
其 主要 功能 是 接收 上 位 机 处 理 控 制 核心 的 控制 信息 、 输 出 多 路 控制 型 号 和 协调 控制 多 伺服 器 。 
9S12XS 系列 属于 16 位 微 控制 单元 MCU)， 是 高 性 能 低 成 本 的 HCS08 家 族 中 的 成 员 。 其 内 
核 采 用 12XV2 核 ， 并 且 可 以 使 用 多 种 模块 、 内 存 容量 、 内 存 类 型 和 封装 类 型 。 
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口 主 或 从 传输 设备 口 支持 CAN2.0A 和 了 B 
口 两 个 从 地 址 ，7/10 位 地 址 口 多 达 8 个 端点 
口 标准 速度 〈100kHz》) 和 高 速 wy/ 秒 狐 握 误 
Co 口 1M 位 / 秒 数据 率 

口 兼容 SMBus2.0 和 PMBus 

口 USB2.0 的 全 速 设备 

口 多 达 8 个 端点 

口 专用 数据 缓冲 区 

口 经 过 USB-IF 认 证 


口 高 达 4.5bit/s 
口 支持 LIN、IrDA 编 解码 、 口 全 双 工 ， 主 或 从 传输 


ISO7816-3 智 能 卡 接口 口 高 达 18M/s 的 时 钟 速度 
口 调制 解 调 嚣 CTS/RTS 控 口 CRC 校 验 


制 接口 口 支持 SD/MMC 读 写 操作 





图 4-15 ”STM32 芯片 通信 接口 模块 图 


9S12XS 总 线 速度 达 40MSs， 具 有 低 电 压 检 测 /中 断 、 错 误 校 正 码 等 系统 保护 机 制 ， 谐 振 器 
XSOC 控制 输出 幅度 的 能 力 ， 同 时 具有 低 功 耗 和 强 抗 噪 ， 节 省 外 围 器 件 的 特性 。 有 具有 12 位 转 
换 时 间 小 于 2.12hs 的 高 速 ADC。 小 而 区 flash 模拟 的 EEPROM。 时 钟 外 设 中 ，9S12XS128 具 
有 8 个 8 位 便 件 PWM 输出 ， 以 及 增强 型 捕捉 定时 右 (ECT)、 通 用 定时 器 (TIM)、 周 期 性 中 
汤 定 时 占 (PIT)。 由 于 机 器 人 乍 要 的 角 位 移 伺 服 占 需要 TTL 电 平 信号 驱动 ， 并 且 多 关 市 的 伺 
服 器 需要 较 多 的 信号 输出 口 ，9S12XS128 拥有 丰富 的 莱 容 TTL 高 速 JO， 可 以 担当 40 路 控制 
言 写 输出 作为 运动 控制 核心 。 

其 主要 便 件 特 性 如 下 : 

1) SI2xCPU， 最 高 总 线 速度 40MHz。 

2) 64KB，128KB，256KB 闪存 选项 ， 均 市 有 错误 校正 功能 (ECC)。 

3) 带 有 ECC 的 4KB-8KB Dataflash， 用 于 实现 数据 和 程序 存储 。 

4) 可 配置 8，10 或 12 位 模 数 转换 器 (ADC)， 转 换 时 间 3hs。 

5) 支持 CAN、LIN 和 SPI 协议 模块 。 

6) 市 有 16 位 计数 匿 、8 通道 定时 器 。 

9S12XS128 心 片 包 售 三 个 独立 定时 右 /PWM 模块 ， 文 持 传统 的 输入 捕捉 ， 输 出 捕捉 及 天 
绥 种 的 边沿 对 齐 PWM。 每 个 TPM 有 一 个 控制 位 配置 所 有 的 通路 产生 中 心 对 齐 的 PWM 信和 号 。 
在 每 一 个 TPM 中 ， 定 时 功能 是 基于 对 独立 的 带 分 频 费 及 模块 化 的 16 位 计数 器 来 控制 频率 和 
范围 《溢出 周期 )， 此 计时 系统 非常 适 于 多 种 控制 应 用 ， 高 速 定 时 器 与 PWM 模块 将 保证 运动 
控制 核心 具有 稳定 的 控制 精度 。 

世 片 包含 两 个 独立 的 串 行 通信 接口 模块 (SCI)， 也 称 为 通用 异步 收发 器 (USART )。 
9S12XS128 片 内 SCI 提供 了 多 种 高 级 特性 ， 这 些 特性 很 少 在 其 他 舱 入 式 控 制 器 的 异步 串 行 设 
备 中 出 现 。 接 收 器 使 用 先进 的 数据 采样 技术 确保 可 靠 的 通信 和 噪声 检测 。 也 包括 便 件 奇偶 校 
验 、 接 收 嚣 唤醒、 发送 和 接收 的 双 绥 冲 。 优 越 的 通信 模块 也 使 得 机 器 人 能 实时 接收 到 上 位 机 
传递 的 控制 信息 ， 保 证 运动 控制 核心 能 对 多 各 个 伺服 器 进行 稳定 实时 的 控制 。 

图 4-16 所 示 为 ARM 硬件 系统 和 飞 思 卡尔 芯片 最 小 系统 。 
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图 4-16 ARM 便 件 系统 和 飞 思 卡 尔 心 片 最 小 系统 


2. 电动 机 模块 设计 
狐 型 节 股 机 费 人 电动 机 分 布 如 图 4-17 所 示 。 新 型 节 及 机 器 人 采用 多 关节 多 张 动 左 张 动 ， 
共有 40 个 驱动 左 ， 其 中 包括 32 个 角 位 移 伺服 电动 机 和 8 个 直流 电动 机 。 









角 位 移 伺 服 电动 机 《能 机 ) 


MAXON 直 流 电动 机 


图 417 产 型 节肢 机 器 人 电动 机 分 布 

C1) 角 位 移 伺服 电动 机 ”能 机 ， 简 单 地 说 就 是 集成 了 直流 电动 机 、 电 动机 控制 项 和 减速 顽 
等 ， 并 封闭 在 一 个 便于 安 朔 的 外 元 里 的 伺服 单元 。 能 机 的 主体 结构 如 网 4 和 -18 所 示 ， 主 要 包括 : 
外 元、 减速 次 轮 组 、 电 动机 、 电 位 右 、 控 制 电路 。 简 单 的 工作 原理 是 控制 电路 接收 信和 号 源 的 控 
制 信号 ， 并 驳 动 电动 机 转动 ， 齿轮 组 将 电动 机 的 速度 成 大 倍数 缩小 ， 并 将 电动 机 的 输出 扭 定 放 
大 相应 倍数 ， 然 后 输出 ， 电 位 句 和 齿轮 组 的 末 级 一 起 转动 ， 训 量 舵 机 轴 转 动 角度 ; 电路 板 检测 
并 根据 电位 右 判 断 艇 机 转动 角度 ， 然 后 控制 能 机 转动 到 目标 角度 或 保持 在 目标 角度 。 

能 盘 

















控制 线 / 


下 完 


图 4-18 能 机 的 主体 结构 
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直流 角 位 移 伺 服 器 具有 良好 的 关节 驱动 性 ， 内 部 集成 功率 放大 器 ， 直 流 电 动机 ， 反 馈 电 
位 器 ， 四 级 减速 机 构 ， 以 及 位 置 控 制 集成 电路 。 经 过 综合 对 比 主流 舵 机 产品 性 能 ， 选 用 辉 盛 
MG995 金属 齿轮 艇 机 伺服 右 作 为 新 型 节 股 机 器 人 的 驱动 器 件 ， 器 件 相 关 参 数 见 表 4-2。 

辉 万 MG995 型 伺服 咒 具 有 大 功率 输出 特性 ， 一 个 伺服 器 具有 高 达 130N'cm 扭矩 。 根 据 节 肌 
机 右 人 模拟 结构 , 进行 估算 , 采用 MG995 为 伺服 器 的 机 器 人 将 共有 不 小 于 25kg 的 整体 负载 能 


表 4-2 辉 盛 MG995 金属 齿轮 舵 机 伺服 器 参数 表 


工作 电压 结构 材质 金属 铜 齿 ， 空 心 杯 电动 机 ， 双 滚珠 轴承 
工作 扭矩 反应 转速 无 负载 速度 0.17%60。 (4.8V)、0.13s/60” (6.0V) 
8 


一 二 30cm， 信 号 线 〈 黄 ) 电源 线 (红线 ) 地 线 〈 瞳 红 ) 

(2) 直流 电动 机 选 型 ”根据 性 能 要 求 并 兼顾 质量 与 耐用 性 ， 选 用 瑞士 MAXON 公司 的 
MAXON 直流 有 刷 电 动机 ， 其 特点 是 : 体积 小 、 重 量 轻 、 线 性 度 好 【无 齿 模 效应)、 转 动 惯 量 
小 、 反 应 迅速 、 过 和 载 能 力 强 、 效 紊 蜗 及 民 好 的 抗 电磁 干扰 能 力 等 。MAXON 电动 机 应 用 非常 
广泛 : 可 用 于 精密 医疗 仪器 及 医疗 设备 、 精 密 光 学 仪 占 、 测 量 仪 右 、 目 动 化 仪表 、 安 防 系 列 、 
工业 控制 系统 及 机 器 人 人、 航空 、 航 天 等 高 科技 领域 。 

由 于 机 器 人 对 直流 电动 机 的 得 出 力矩 有 一 定 的 要 求 , 选择 瑞士 MANON 22mm 至 心 杯 伺服 减 
速 电动 机 ， 同 时 电动 机 集成 编码 器 ， 可 以 直接 检测 反馈 电动 机 速度 信息 。MAXON 022-00.19-31 
伺服 电动 机 如 图 4-19 所 示 。 其 主要 参数 见 表 4-3。 


















































图 4-19 MAXON 022-00.19-31 伺服 电动 机 


表 4-3 MAXON 022-00. 19-31 主要 参数 


额定 电压 25V 
转速 46r/min 
减速 比 1:256 
码 盘 精 度 100 线 
A 机 身 直径 22mm， 长 9I1mm， 轴 径 4mm 


3. 驱动 电路 设计 
由 于 多 关节 机 堪 人 电动 机 多 达 40 个 ， 并 由 两 种 伺服 张 动 右 驱动 ， 所 有 张 动 磊 均 需 要 驱动 
电路 。 其 中 ， 有 制 直流 电动 机 属 感性 负载 ， 驱 动 蕊 厂 采 用 L298N 恒 压 恒 流 桥 式 2A 驱动 心 
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L298N 是 SGS 公司 推出 的 专用 于 直流 电动 机 驱动 的 HH 桥 组 件 , 其 全 称 为 双 极 性 H 桥 式 集成 电 
路 ,如 图 4-20 所 示 。L298N 内 部 包含 4 通道 逻辑 驱动 电路 ， 可 以 方便 地 驱动 两 个 直流 电动 机 。 
同一 蕊 片上 集成 有 CMOS 控制 电路 和 DMOS 功率 器 件 ， 利 用 它 可 以 与 主 处 理 器 、 电 动机 和 增 
量 型 编码 器 构成 一 个 完整 的 运动 控制 系统 。 一 片 L298N 芯片 可 以 驱动 两 个 二 相 电 动机 ， 也 可 
以 驱动 一 个 四 相 电 动机 ， 输 出 电压 最 高 可 达 50V， 可 以 直接 通过 电源 来 调节 输出 电压 ， 可 以 
直接 用 单片机 控制 系统 的 IO 口 提 供 信号 ， 而 且 电路 简单 ， 使 用 比较 方便 ， 极 大 地 减少 了 外 围 
电路 设计 ， 增 强 机 器 人 驱动 系统 的 稳定 性 。 

















LOGIC SUPPLY VOLTAGE Vss 
GND 

INPUT 2 

ENABLE A 

INPUT1 

SUPPLY VOLTAGE Vs 
OUTPUT2 

OUTPUT1 

CURRENT SENSINGA 





二 散热 片 与 8 脚 连通 
4-20 ”L298N 世 
L298N 可 接受 标准 TTL 逻辑 电 平 信号 VSS，VSS 可 接 4.5~7V 电压 。4 脚 VS 接 电源 电 
压 ，VS 电压 范围 VIH 为 2.5~46V。 输 出 电流 可 达 2.SA， 可 驱动 电感 性 负载 。1 脚 和 15 脚下 
管 的 发 射 极 分 别 单独 引出 以 便 接 入 电流 采样 电阻 ， 形 成 电流 传 感 信 号 。 图 4-21 所 示 为 双 H 桥 
直流 电动 机 驱动 板 功 能 图 解 。 
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H 桥 心 电源 指示 
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逻辑 部 分 -一 = 
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图 4-21 双 互 桥 直流 电动 机 驱动 板 功 能 图 解 
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4.3.3 ” 步 态 探 制 理论 与 技术 


运动 足 的 目 由 度 配 置 如 网 4-22 所 示 。 根 据 结构 设计 技术 中 对 于 机 器 人 运动 趾 结构 尺寸 设 
计 ， 确 定 了 运动 足 关 键 尺 寸 与 各 关节 运动 空间 : 根 关 节 用 于 侧 摆 ， 摆 动 范 围 为 [0”，135"” ]， 
基 广 长 为 5mm; 艇 天 市 用 于 信仰 ， 俯 仰 抑 围 为 [-90”，45”]， 股 节 忆 长 为 61.7mm; 膝 天 
节 用 于 届 健 ， 届 伸 范 围 为 [0”，135”]， 腾 节 长 为 73.5mm; 中 关节 用 于 择 向 ， 选 择 范 围 为 
[0”，180”]， 跟 和 0 长 为 34mm。 根 据 机 械 结 构 设 计 分 析 ， 并 进行 目 由 度 抽 和 象 配置 ， 可 近似 
假设 质心 居于 几何 中 点 ， 根 据 具 体 参数 对 运动 足 建 模 如 图 4-23 所 示 。 




















QC (xl，p81,， 71) 
hn i 


1 


(a2, B2, 72) 


(a3, B3, 73) 





(as, BS5, 75) 
图 4-22 ”运动 足 自 由 度 人 条 网 图 4-23 ”运动 足 模 型 
根据 各 关节 之 间 的 距离 hh，L5，J3，L4，r 及 各 骨 广 与 参考 坐标 系 各 轴 之 间 的 夹 角 a，p，y， 
即 可 求 得 各 转动 天 广 在 参考 坐标 系 中 的 矩阵 表达 式 。 
第 一 个 关节 一 一 根 关 节 的 坐标 为 0，0，0)， 则 其 他 四 个 关节 及 着 地 点 在 参考 坐标 系 中 
的 角度 算 阵 为 




















Pi=|sin@ sn siny| 

P=|sin@g, sinpb, siny, | 
Ps=|[sin@, sn siny,| 
P= [sin 2 sinp, siny, | 


Ps=|sin@, sn siny,| 

根据 上 述 各 关节 及 看 地 点 的 矩阵 ， 可 求 的 各 关节 点 在 参考 坐标 系 中 的 位 置 坐 标 为 

根 关节 : So= (0，0，0) 

髋 关节: S1=SotlPI 

膝 关 市 ; Ss=S1+1P 

躁 关 节 : S3=5$5+13P3 

转 轮轴 : S=S3+AP4 

看 地 点 : 95=S4+7P。 

其 中 : =5mm，b=61.7mm，4=73.5mm，4=34mm，7=35mm。 根 据 上 述 各 关节 和 着 地 点 
的 坐标 公式 ， 即 可 得 到 当 机 器 人 运动 时 各 关 市 点 的 坐标 关系 式 ， 进 行 运动 学 正解 和 运动 学 反 
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解 运算 ， 即 可 得 到 各 关 和 点 的 控制 角度 ， 进 而 得 到 高 精度 直流 伺服 电动 机 和 大 角度 精密 转角 
舵 机 的 控制 量 ， 对 其 进行 精密 控制 ， 精 确 地 实现 所 涉及 的 机 器 人 运动 步 态 控制 。 

1. 运动 学 正解 与 运动 学 反 解 推导 

(1) 位 置 正 解 求 法 “运动 学 正解 问题 是 给 定 各 个 天 季 处 各 骨 世 相对 于 参考 坐标 系 的 角度 ， 
求解 运动 腿 看 地 点 在 参考 坐标 系 中 的 位 置 坐 标 。 采 用 数值 解法 从 式 中 解 出 不 同 控制 角度 时 洲 
地 点 在 参考 坐标 系 中 的 坐标 ， 计 算 结 果 见 表 4-4。 


表 4-4 位 置 正解 计算 结果 























Be 165 152 207 131 0 

2 111 184 239 186 73 
节点 3 138 186 241 160 104 
节点 4 186 186 241 112 153 
有 150 132 187 148 169 
节点 6 Wo 186 241 186 240 
节点 7 185 186 241 113 315 








(2) 位 置 反 解 求法 “求解 位 置 反 解 即 给 定 机 郑 人 运动 腿 看 地 点 在 参考 坐标 系 中 的 位 置 坐 
标 ， 求 解 机 吉 人 每 条 运动 腿 上 各 关节 处 转动 的 角度 ， 即 各 关节 处 能 机 和 下 流 伺服 电动 机 的 控 
制 量 。 根 据 图 4-23 中 运动 腿 的 空间 建 模 及 各 关节 点 的 坐标 公 邢 可 知 ， 最 终 机 器 人 的 落地 点 坐 
标 为 

Xss =1SImnw +h, sinQ, 二 ASImos 十 Sin Co 十 六 SIn Cs 


Yss =7 sinp +h, sinp, +hsinps, +lsinp, +rsinA 


Zss =[ sin ny +h, siny, +h siny; +h, sinys +r snys 

其 中 ， Xs; 为 运动 时 侧 癌 位 移 ， ;为 运动 时 前 进 的 距离 ; Zs; 为 运动 时 的 机 体 离 地 高 度 。 

根据 以 上 分 析 可 知 ， 给 定 机 絮 人 的 落地 点 位 置 后 ， 应 当 逐 次 确定 54、53、S2 和 S51， 进而 
人 硝 定 各 关节 处 的 控制 角度 。 但 各 头 贡 点 的 坐标 之 间 相 互 关 联 ， 构 成 一 组 不 定 方程 ， 因 此 方程 
的 解 并 不 是 唯一 确定 的 解 ， 即 相对 于 同一 给 定 的 看 地 后 坐标 ， 可 由 不 定 方程 组 解 得 多 组 控制 
量 。 因 此 通过 位 置 反 解 求 取 控制 量 时 ， 需 要 结合 机 坪 人 各 关节 的 运动 角度 范围 和 机 械 结 构 限 
制 选择 最 优 解 。 

经 过 运动 正解 和 运动 反 解 的 严密 推导 ， 证 明了 机 需 人 的 运动 腿 能 在 其 机 械 设 计 的 可 达 域 
中 目 由 控制 。 更 进一步 ， 为 了 使 机 堪 人 的 运动 达到 最 佳 效率 ， 将 运动 正解 和 运动 反 解 的 解 算 
结 朱 作为 机 器 人 的 控制 量 之 前 ， 应 根据 机 堪 人 的 目 吴 重量 和 运动 地 面 的 光 请 度 等 因素 对 控制 
量 进行 适当 的 修正 补 颂 。 

2. 步 态 多 样 性 的 探究 

新 型 三 胶 机 融 人 的 功能 展示 性 主要 体现 在 其 运行 步 态 的 多 样 性 ， 其 结合 了 抽象 仿生 学 的 
相关 设计 原理 ， 在 结构 和 步 态 设计 上 ， 有 机 结合 了 昆虫 代行 姿态 和 轮 式 机 械 行 进 的 特点 ， 在 
控制 系统 的 统筹 下 分 别 设计 了 昆虫 的 多 足 爬 行 、 迟 蟹 的 横 癌 侧 行 、 仿 人 的 腿 式 行走 、 蛇 式 的 
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独居 前 进 、 机 车 的 轮 式 深 动 、 履 市 式 移动 平台 的 原 地 旋转 等 多 种 行进 步 态 。 多 是 机 右 人 的 运 
动 轨迹 是 一 系列 离散 的 足 印 运动 ， 即 只 需要 离散 的 点 接触 地 面 。 其 运动 对 环境 的 破坏 程度 较 
小 ， 其 足 部 可 以 在 可 能 到 达 的 地 面 上 选择 最 优 的 文 返点 ， 对 师 虹 地 形 的 适应 性 强 。 在 多 是 步 
行 机 器 人 的 步行 过 程 中 ， 机 器 人 的 每 条 腿 《〈 足 ) 根据 一 定 的 运动 轨迹 顺序 提起 和 放下 ， 因 此 
可 以 把 步 态 分 解 为 摆动 相 与 文 撑 相 。 以 虹 胡 横 行 步 态 为 例 ， 通 过 对 该 步 态 的 实际 观察 结果 可 
以 得 出 蟒 蟹 横行 步 态 的 时 序 独 ， 如 疼 4-24 所 示 ， 黑 色 部 分 表示 摆动 相 ， 上 日 色 表 示 文 撑 相 )。 
图 4-25 为 缔 稻 足 部 标号 设 定 。 由 此 出 发 ， 将 生物 步 态 与 机 器 人 的 仿生 步 态 程序 设计 相 结合 ， 
即 可 实现 步 态 由 生物 体 到 机 右 人 的 移植 转化 。 

在 探索 新 型 节 胶 机 右 人 扩展 步 态 时 ， 通 过 对 履 市 式 移 动 平台 的 履 市 运动 规律 的 观察 、 总 
结 与 推广 ， 如 履 市 式 移动 平台 的 原 地 旋转 。 对 于 履带 式 机 器 人 而 言 ， 在 实现 原 地 旋转 功能 的 
时 候 ， 只 需要 保证 两 侧 的 履 帝 以 相同 的 转速 与 相反 的 转向 进行 运动 即 可 实现 。 而 对 于 如 新 型 
节 及 机 磊 人 这 种 足 部 结构 为 轮 腿 结合 式 的 机 器 人 而 言 , 运用 中 部 末端 衣 机 驱动 的 深 轮 实现 原 
地 旋转 功能 时 了 吏 必 须 进 行 特殊 的 步 态 设 计 。 因 为 对 于 任何 原 地 旋转 的 物体 而 言 ， 其 上 任意 一 
扩 均 在 其 所 在 的 一 个 与 地 面 平行 的 平面 内 形成 一 个 以 东 一 点 为 中 心 的 圆 形 轨迹 。 受 此 局 发 ， 
结合 新 型 节 股 机 器 人 的 对 称 结构 特性 ， 如 图 4-26 所 示 ， 将 每 条 腿 第 四 个 关节 处 都 旋转 一 个 
特定 的 角度 以 后 , 使 得 在 机 如 人 俯视 图 中 每 条 腿 末 端 模 问 直 流 有 刷 电 动机 旋转 轴线 的 反 向 延 
长 线 交 于 一 点 O， 且 O 所 应 该 与 俯视 图 中 机 右 人 的 几何 对 称 中 心 重合 。 然 后 ，1、3、5、7 
足 的 未 冰 滩 轮 与 2、4、6、8 足 的 末 中 滚轮 分 别 以 相同 转速 、 相 反 转 同 转 动 ， 即 可 完 关 模拟 
履 市 式 机 需 人 的 原 地 旋转 功能 。 









































图 4-24” 蟒 稻 横行 步 态 的 时 序 疼 











图 4-25 ”螃蟹 足 部 标号 设 冠 图 4-26 原 地 旋转 时 机 器 人 足 部 布局 图 


4.3.4 ” 传 感 探测 技术 
新 型 节肢 机 器 人 反馈 及 传 感 模块 由 加 速度 传感器 MMA7361、 有 具有 温度 补偿 的 数字 化 超声 
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流传 感 融 向 清 报 像 尖 模块 组 成 。 加 速度 传 感 费 检测 机 各 人 在 xyz 三 个 方 回 的 加 速度 ,为 处 理 
控制 核心 控制 机 器 人 改变 姿态 以 适应 各 种 地 形 提 供 机 右 人 姿态 信息 。 超 声波 传 感 疾 和 摄像 头 
用 于 障 丛 物 检测 和 视觉 系统 构建 ， 其 中 超声 流传 感 占 获得 机 帮 人 与 周围 障碍 物 或 者 目标 障 翁 
物 之 间距 离 ， 使 得 新 型 节 及 机 各 人 其 有 目 动 避 障 功能 和 目标 测 距 功 能 。 局 消 摄 像 尖 能 够 获取 
机 左 人 前 方 180” 范 围 内 的 视频 图 像 , 通过 无 线 通 信和 模块 将 视频 图 像 传 输 全 上 位 机 实现 对 环境 
勘测 和 操作 人 人 员 对 机 右 人 的 远程 遂 控 。 

(1) 加 速度 传感器 ”加 速度 传感器 利用 压 电 效应 原理 制 成 。 所 谓 的 压 电 效应 融 是 对 于 不 
存在 对 称 中 心 的 异 极 晶体 加 在 晶体 上 的 外 力 ， 除 了 使 晶体 发 生 形变 以 外 ， 还 将 改变 晶体 的 极 
化 状态 ， 在 品 体 内 部 建立 电场 ， 这 种 由 于 机 械 力作 用 使 介质 发 生 极 化 的 现象 称 为 正 压 电 效 应 。 
加 速度 传 感 右 束 古 利用 了 其 内 部 的 由 于 加 速 有 度 造成 的 晶体 变形 这 个 特性 。 由 于 这 个 变形 会 产 
生 电 压 ， 只 要 计算 出 产生 电压 和 所 施加 的 加 速度 之 间 的 关系 ， 就 可 以 将 加 速度 转化 成 电压 和 输 
出 。 加 速度 传 感 融 如 图 4-27 所 示 。 






























































图 4-27 加 速度 传 感 右 

(2) 超声 波 传 感 器 ”超声 波 传 感 器 是 利用 超声 波 的 特性 研制 而 成 的 传感器 ， 由 发 送 传 感 
器 《也 称 为 波 发 送 右 )、 接 收 传感器 (也 称 为 波 接 收费 )、 控 制 部 分 与 电源 部 分 组 成 。 友 送 占 
传感器 由 友 送 器 与 使 用 直径 为 15mm 左右 的 陶瓷 振子 换 能 器 组 成 ， 换 能 右 作 用 是 将 陶瓷 振子 
的 电 振 动能 量 转换 成 超 能 量 并 癌 宇 中 辐射 ， 而 接收 传感器 由 陶瓷 振子 换 能 器 与 放大 电路 组 成 ， 
换 能 器 接收 波 产生 机 械 振动 ， 将 其 变换 成 电能 量 ， 作 为 传感器 接收 器 的 输出 ， 从 而 对 发 送 的 
超声 波 进 行 检 测 ， 而 实际 使 用 中 ， 用 于 发 送 传感器 的 陶瓷 振子 也 可 以 用 做 接收 需 传 感 器 的 陶 
瓷 振子。 控制 部 分 主要 对 发 送 需 发 出 的 脉 神 链 频率 、 占 衬 比 及 稀 焉 调制 和 计数 及 探测 距离 等 
进行 控制 。 超 声波 传感器 电源 “〈 或 称 信和 号 源 ) 可 用 DC 〈12+10%) V 或 (24+10%) V。 超 声 
波 传 感 咒 如 图 4-28 所 示 。 















































图 4-28 超声 波 传感器 


大 学 生 课 外 科技 创新 竞赛 获奖 作品 精 析 








(3) 摄像 头 模 块 ” 摄 像 头 常 分 为 彩色 和 黑白 两 种 摄像 头 ， 主 要 工作 原理 是 : 按 一 定 的 分 
办 率 ， 以 隔行 扫 摘 的 方式 采样 图 像 上 的 点 ， 当 扫描 到 某 点 时 ， 驶 通过 网 像 传 感 忌 卢 将 该 点 处 
图 像 的 灰 度 转换 成 与 灰 度 成 一 一 对 应 关系 的 电压 值 ， 然 后 将 此 电压 值 通过 视频 信号 端 输出 。 
摄像 头 模 块 如 图 4-29 所 示 。 











图 4-29 ”摄像头 模 块 


4.3.5 ”无线 通信 技术 


新 型 节肢 机 器 人 应 用 无 线 通信 技术 实现 上 位 机 与 下 位 机 的 通信 和 遥 操 作 控 制 信 号 传输 。 
通过 无 线 系 统 组 成 的 级 联 导 航 系 统 可 以 实现 机 器 人 的 数据 返回 PC 端 处 理 , 所 采用 的 自 适 应 卡 
尔 曼 滤波 算法 能 够 有 效 地 减少 采集 误差 。 无 线 模块 (REF wireless module) 是 利用 无 线 技术 进 
行 无 线 传输 的 一 种 通信 模块 ， 广 泛 应 用 于 电脑 无 线 网 络 、 无 线 通 信 、 无 线 控制 等 领域 。 节 胶 
机 器 人 遥 操 作 控 制 信号 传输 所 用 无 线 模块 主要 由 发 射 器 、 接 收回 和 控制 器 组 成 。 无 线 模块 接 
收 端 实物 图 如 图 4-30 所 示 。 

















图 4-30 无线 模块 接收 端 实物 图 

数据 发 射 模块 的 工作 频率 为 31SM， 采 用 声 表 谐振 吉 SAW 稳 频 ， 频 率 稳 定 度 极 高 ， 当 环 
境 温 度 在 -25 一 +8SC 之 间 变 化 时 ， 频 漂 仅 为 3x10《*/”。 特 别 适合 多 发 一 收 无 线 遥 控 及 数据 传 
输 系 统 。 发 射 模块 未 设 编码 集成 电路 ， 而 增加 了 一 只 数据 调制 三 极 管 Q1， 这 种 结构 使 得 它 可 
以 方便 地 和 其 他 固定 编码 电路 、 滚 动 码 电路 及 单 族 机 接口 ， 而 不 必 考 虑 编 伍 电路 的 工作 电压 
和 输出 幅度 信号 值 鸭 大 小 。 

数据 模块 具有 较 宽 的 工作 电压 范围 为 3 一 12V,， 当 电压 变化 时 发 射频 率 基 本 不 变 ， 和 发 
射 模块 配套 的 接收 模块 无 需 任何 调整 就 能 稳定 地 接收 。 当 发 射电 压 为 3V 时 ， 衬 及 地 传输 
距离 约 20 一 5S0m, 发 射 功率 较 小 ; 当 电 压 5V 时 约 100 一 200m; 当 电 压 9V 时 约 300 一 5S00mi 
当 发 射电 压 为 12V 时 ， 为 最 佳 工作 电压 ， 具 有 较 好 的 发 射 效 果 ， 发 射电 流 约 60mA， 空 及 
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地 传输 距离 700 一 800m， 发 射 功 率 约 500mW。 当 电压 大 于 12V 时 功 耗 增 大 ， 有 效 发 射 功 
率 不 再 明显 提高 。 这 套 模块 的 特点 是 发 揣 功 率 比 较 大 ， 传 输 距 离 比 较 远 ， 比 较 适 合 恶 劣 条 
件 下 进行 通信 。 

数据 模块 采用 ASK 方式 调制 ， 以 降低 功 耗 ， 当 数据 信号 停止 时 发 射电 流 降 为 零 ， 数 据 信 
号 与 发 射 模 块 输入 端 用 电阻 或 者 直接 连接 。 


4.3.6 ”电源 管理 技术 


机 器 人 电源 模块 为 直流 电动 机 、 能 机 、ARM 控制 电路 、Freescale 控制 电路 、 传 感 器 电路 
等 模块 的 供电 ， 由 于 不 同 模块 所 需 电 源 有 不 同 的 电压 要 求 、 功 率 要 求 等 。 所 以 ， 探 制 电路 的 
电源 模块 是 机 器 人 便 件 系统 重要 部 分 ， 作 品 中 采用 双 电 源 供电 模式 ， 如 图 4-31 所 示 。 


25V 大 功率 锝 铁 电池 | 2 >|8 个 减速 直流 有 刷 电动 机 
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ARM 控 制 核 心 
5V 
Freescale 控 制 核 心 传感器 模块 
5V 控 制 信号 


[4 大 开平 全 电池 
图 4-31 机 器 人 硬件 系统 双 电 源 供电 模式 


供电 电池 组 合 由 25V 大 功率 锂 铁 电 池 和 7.4V 锂电 池 组 成 。 为 满足 不 同 模块 对 不 同 电源 的 
要 求 ， 电 源 模块 在 硬件 设计 上 ， 采 用 较为 先进 的 压 差 调节 需 式 设计 ， 在 节省 控制 电源 数量 的 
同时 ， 保 证 了 系统 的 功率 需求 和 稳定 性 。 

1) 直流 电动 机 的 额定 电压 为 23SV， 直 接 从 25V 锂 铁 电 池 经 过 稳 压 模块 供电 。 

2) Freescale 单 户 机 及 传感器 等 相关 的 SV 供电 外 设 采 用 LM2596-5.0V DCDC 模块 供电 。 

3) STM32 微 处 理 器 采用 LM1117-3.0V 提供 的 3.3V 电源 ， 满 足 了 低 功 耗 要求 。 

LM1117 是 一 个 低压 差 电 压 调节 器 系列 。 其 压 差 在 1.2V 输出 ， 负 和 载 电 流 为 800mA 时 为 
1.2V。LM1117 有 可 调 电 压 的 版 本 ， 通 过 2 个 外 部 电阻 可 实现 1.25 一 13.8V 输出 电压 范围 。 吨 
外 还 有 5 个 固定 电压 输出 (1.8V、2.5V、2.85V、3.3V 和 5V) 的 型 号 ， 在 本 项 目 中 用 于 3.3V 
与 5V 的 电压 输出 ， 其 主要 为 电路 中 各 必 片 提供 电流 。LM1117 硬件 特性 如 下 : 

1) 提供 1.8V、2.5V、2.85V、3.3V、5V 和 可 调 电 压 的 型 号 。 

2) 节省 空间 的 SOT-223 和 LLP 封装。 

3) 过 电流 限制 和 热 体 护 功能 。 

4) 输出 电流 可 达 800mA。 

5) 线性 调整 率 ，0.2% (最 大 )。 

6) 负载 调整 率 ，0.4% (最 大 )。 

7) 温度 范围 : -40 一 125S'C 。 

LM1117 电路 原理 图 设计 如 图 4-32 所 示 。 
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LMI1117 VOUT 


GND 





图 4-32 LMI1117 电路 原理 图 


4.3.7 ”软件 程序 开发 技术 


1， 运 动 控制 核心 软件 设计 

运动 控制 核心 软件 设计 框图 如 图 4-33 所 示 。 

下 层 软件 基于 运动 控制 核心 采用 Freescale 9S12XS128 单片机 控制 ， 其 主要 功能 是 输出 占 
宇 比 可 调 的 32 路 舵 机 控制 PWM 信号 和 8 路 占 空 比 、 频 京 可 调 的 直流 电动 机 PWM 信号。 同 
时 检测 直流 电动 机 编码 器 信号 反馈 给 上 位 机 。 













低 电 压 检 测 中 断 


图 4-33 ”运动 控制 核心 软件 设计 框图 

32 路 PWM 输出 采用 Freescale 9S12XS128 单片机 IO 输出 引 脚 配合 16 位 定时 器 输出 ， 
定时 需 在 每 个 中 断 对 0 一 31 路 的 每 路 信号 进行 电 平 翻转 判定 ， 在 10hs 的 控制 周期 内 ， 实 
现 32 路 PWM 信和 号 输出 。32 路 舵 机 的 PWM 信号 是 对 艇 机 的 角度 控制 与 速度 控制 ， 输 出 
言 号 的 频率 为 50Hz， 占 空 比 可 调 〈5% 一 15%)， 调 节 精 度 正 好 达到 角 位 移 伺服 器 的 死 区 
10hs， 保 证 控制 器 对 角 位 移 体 服 器 的 最 佳 控制 。8 路 直流 电动 机 的 PWM 信和 号 是 对 直流 有 
刷 电动 机 的 速度 控制 ， 通 过 改变 占 空 比 ， 配 合 编码 器 反馈 组 成 PID 控制 器 实现 对 直流 电动 
机 的 速度 稳定 控制 。USART 模块 实现 从 上 位 机 接收 的 40 个 伺服 器 的 控制 目标 值 ， 用 以 输 
出 合适 的 控制 信号 。 同 时 下 层 软件 将 同上 位 机 反馈 速度 等 数据 信息 ， 为 上 位 机 处 理 探 制 核 
心 提供 控制 数据 。 

2. 处 理 控制 核心 软件 设计 

处 理 控制 核心 采用 以 STM32 为 核心 的 控制 蕊 片 ， 是 机 器 人 控制 系统 的 核心 部 分 ， 承 
担 中 央 CPU 处 理 和 与 各 个 模块 衔接 枢纽 的 重要 工作 。 处 理 控制 核心 软件 设计 框图 如 图 
4-34 所 示 。 
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图 4-34 处理 控制 核心 软件 设计 框图 

基于 STM32 的 控制 核心 软件 系统 主要 包括 系统 初始 化 、 串 行 总 线 通 信 、SPI 数据 传输 、 
USB 静态 存储 、 传 感 嚣 检测、 运动 控制 算法 、 运 动 决策 、 步 态 控制 信号 计算 。 所 有 控制 模块 
都 是 以 1ms 为 控制 周期 进行 的 ， 实 现 对 机 器 人 的 实时 控制 。 控 制程 序 是 基于 C 语言 、 玉 用 模 
块 化 程序 设计 的 基本 思路 ， 程 序 设 计 紧 诸 。 

系统 初始 化 主要 是 对 处 理 控 制 核心 的 各 个 模块 进行 初始 化 ， 并 告诉 各 个 模块 ， 机 器 人 的 
主 程序 CPU 已 经 开始 运行 ， 进 入 主 循环 ， 各 模块 开始 运行 。 

串 行 总 线 通 信 模 块 采 用 高 速 串 行 模块 ， 辐 下 位 机 传输 40 路 伺服 器 的 控制 信号 ， 以 115200 波 特 
率 高 速 传输 信号 。SPI 传输 模块 是 STM32 处 理 控制 核心 将 机 右 人 运动 参数 ， 运动 状态 等 信息 传递 给 
无 线 模块 用 以 无 线 模 块 传输 人 至 PC 问 ， 并 接受 上 位 机 的 简单 决策 信 写 ， 实 现 对 机 右 人 的 远程 操控 。 

USB 静态 存储 模块 是 机 器 人 与 其 他 外 部 存储 介质 之 间 的 通信 模块 , 调试 阶段 可 以 将 机 器 人 参 
数 性 能 等 数据 储存 起 来 ,用 以 调 斌 分析， 优化 参数 。 成 品 阶段 可 以 将 机 器 人 感知 的 数据 静态 存储 ， 
即使 机 右 人 在 侦查 过 程 中 齐 到 破坏 也 能 保存 香 要 的 侦查 资料 ， 增 加 了 机 器 人 侦查 作战 性 能 。 

传感器 检测 模块 中 ， 以 高 速 ADC 为 基础 的 加 速度 传感器 数据 采集 ,返回 机 右 人 当前 映 体 姿 
态 ， 使 得 机 器 人 可 以 目 动 调节 豫 体 ， 能 适应 更 多 环境 。 以 定时 需 电 平 捕捉 模块 为 基础 的 超声 小 
传 感 模 块 ， 与 云 台 配合 控制 ， 使 机 各 人 能 检测 出 前 方 障 人 碍 物 的 距离 、 方 同等 重要 信息 。 以 报 像 
头 为 基础 的 传 感 檬 块 将 机 器 人 看 到 的 信号 存储 至 外 部 存储 右 ， 或 是 通过 无 线 模块 传人 至 PC。 

运动 控制 算法 模块 采用 先进 的 多 轴 控 制 技 术 ， 通 过 整体 姿态 的 软件 建 模 ， 坐 标 变 换 与 控 
制 分 析 ， 实 现 对 直流 电动 机 与 角 位 移 伺服 需 的 PID 控制 、 模 糊 探 制 。 

运动 决策 则 是 将 机 器 人 各 个 运动 方式 封装 成 动作 数据 处 理 模 块 ， 直 接 调用 模块 实现 机 器 
人 灵活 的 切换 不 同 种 步 态 ， 充 分 发 挥 其 多 大 市 多 驱动 器 的 特点 ， 以 适应 多 种 复 林 环境 。 

3. 部 分 软件 模块 程序 

运动 控制 核心 模块 Freescale 
9S12XS128 的 软件 设计 是 基于 Freescale 
公司 推出 的 集成 编译 环境 CodeWarrior。 一 ! 被 控 对 象 
该 软件 文 持 C 语言 ， 汇 编 语 言 等 多 种 语 
言 平 台 ， 优 秀 的 仿真 性 能 方便 调试 。 

1) PID 控制 算法 模块 程序 。PID 
控制 硕 结 构 框 网 如 网 4-35 所 示 。 图 4-35 PID 控制 豆 结 多 框 图 
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算法 原理 程序 如 下 : 
int PIDCalc( PID *pp, uint yt ，uint rt ) /通用 PID 计算 算法 
Int dError, Error:;: 
Error = 1t - yt; / 俩 差 
pp->SumError += Error; /积分 
dError = pp->LastError -pp->PrevError; /当前 微分 


pp->PrevError = pp->LastError; 
pp->LastError = Error; 





return (pp->Proportion * Error /比例 项 
+ pp->Integral * pp->SumError // 积 分 项 
+ pp->Derivative * dError /微分 项 
); 
} 
2) 直流 电动 机 速度 控制 模块 与 加 速度 检测 程序 
void PWM service(uint pwm dty) /改变 寄存 器 值 输出 PWM 控制 信号 
/上 = SB clock/40000=50Hz T=20ms 
PWMDTY23=pwm dty: /输入 “0 一 40000 
AD service(void) /AD 转换 PAD0 口 单 路 转换 输入 传感器 检测 值 


static uint ad rev=0; 

uint ad new; 

while(IATDOSTAT0 SCF); /等 待 转换 结束 
ad new=ATIDODR0; 

ad rev=((ad newtad rev*7)>>3); 


return ad rev; /返回 ”0 一 4000 转换 结果 
} 

uint SPEED service(void) /速度 检测 

， 


uint sped rev=0; 
sped rev=PACNT; PACNT=0; 


sped rev=((sped newt+sped rev*7)>>3); // 达 代 滤波 控制 
return sped rev; /返回 
} 


ER 主要 创新 氮 及 取得 成 麻 


4.4.1 ”作品 主要 创新 挟 


作品 主要 创新 点 如 下 ; 

1) 设计 的 新 型 小 尺寸 、 轻 体重 、 多 关节 ， 多 驱动 的 节肢 机 器 人 同时 具备 腿 式 机 器 人 地 形 
适应 性 强 和 轮 式 机 器 人 机 动 速度 高 的 优点 ， 能 够 实现 四 十 余 种 步 态 。 

2) 控制 系统 采用 分 层 递 阶 的 控制 体系 结构 ， 遥 控 与 自主 控制 相 结 合 ， 方 便 操作 人 员 实 现 


@ 











对 机 器 人 本 体 的 有 效 控制 ， 提 高 其 作业 稳定 性 。 
3) 采用 多 电动 机 协调 控制 技术 ， 稳 定 的 实现 对 40 个 电动 机 的 闭环 控制 ， 使 机 器 人 能 够 
在 不 同 地 形 条 件 下 采用 不 同步 态 高 效 运动 。 
4) 采用 先进 的 多 轴 伺 服 运动 控制 技术 ， 保 证 了 机 器 人 在 高 速 运动 中 的 稳定 性 。 
5) 基于 多 线程 技术 和 嵌入 式 技术 开发 了 自主 探测 、 自 动 跟踪 和 自主 避 障 的 实用 性 功能 。 
6) 新 型 节肢 机 器 人 具备 山地 、 丘 陵 等 复杂 地 形 条 件 下 灵活 运动 、 侦 察 探测 的 能 




















4.4.2 ”作品 取得 的 成 果 


作品 取得 的 成 果 如 下 : 

1) 新 型 节肢 机 器 人 实物 样机 1 台 。 

2) 新 型 节肢 机 器 人 研究 技术 报告 1 份 。 

3) 获奖 

(D2011 年 10 月 ， 在 上 海 同济 大 学 举办 的 第 四 届 全 国 大 学 生 创新 年 会 上 获 “ 我 最 喜爱 的 
十 件 作 品 ” 称 号 ， 排 名 第 一 。 

@) 2011 年 “中 俄 工科 大 学 联盟 ”首届 大 学 生机 器 人 创新 大 赛 及 展示 中 获 “ 最 佳 团 队 奖 ” 

















忆 结 与 展望 


在 仿生 学 研究 的 基础 上 ， 设 计 并 研制 了 一 种 新 型 小 尺寸 、 轻 体重 、 多 关节 、 多 运动 步 态 
的 市 上 投 型 机 各 人 ， 疙 备 看 多 达 40 个 的 高 精度 百 流 伺服 电 动机 和 大 角度 精密 转角 能 机 ， 使 乙 在 
非 结 构 化 环 昔 下 的 多 样式 、 多 步 态 行走 ， 有 具备 轮 式 、 腿 却 、 履 市 式 机 需 人 的 综合 优点 。 欧 分 
结合 轮 式 机 器 人 、 多 足 机 如 人 等 运动 特点 及 电路 设计 特点 ， 将 多 种 运动 模式 、 多 种 运动 姿态 
完美 络 合 ， 达 到 流畅 的 完成 复杂 轮 式 运动 ， 又 可 以 在 各 足 尖 点 可 达 范 围 内 灵活 调整 行走 姿态 ， 
并 合理 选择 文 撑 点 保持 稳定 。 

在 设计 中 ， 采 用 Pro/E 软件 精心 设计 了 机 器 人 的 机 械 络 构 ， 并 对 相关 零 部 件 的 机 械 强 度 、 
运动 特性 进行 了 深入 分 析 ， 构 建 了 新 型 节 胶 机 器 人 步 态 控制 的 理论 模型 ， 通 过 对 机 髓 人 运动 
学 正解 与 运动 学 反 解 的 严密 推导， 以 及 对 机 帮 人 多 样式 、 多 步 态 行走 特 后 的 深入 分 析 ， 午 握 
了 新 型 节肢 机 器 人 步 态 控制 的 理论 方法 与 拉 术 途 征 。 经 新 型 节 肌 机 右 人 样机 运动 功能 的 实际 
测试 证 明 ， 该 机 器 人 凭借 独特 的 机 械 设计 与 合理 的 步 态 规划 ， 可 在 复杂 地 形 条 件 下 以 多 样式 、 
多 步 态 忆 效 行进 ， 充 分 证 明 作 品 在 理论 探索 和 技术 实现 方面 的 有 效 性 。 

狐 型 而 股 机 如 人 既 有 机 占 的 轮 式 运动 特色 ， 叉 有 生物 的 腿 式 运动 方式 ， 真 正 实现 了 机 械 
与 生物 的 结合 ， 避 免 了 纯粹 僵 便 的 机 械 运 动 或 者 是 单一 刻板 的 生物 模仿 ， 真 正 吸取 了 两 方面 
的 优势 ， 提 高 了 机 各 人 的 运动 方式 的 多 样 性 和 兼容 性 ， 以 求 达到 完美 的 运动 效果 。 鉴 于 新 型 
广 胶 机 器 人 有 具备 体 积 小 ， 运 动 方式 灵活 多 变 ， 地 形 适 应 能 力 强 ， 探 制 方便 ， 在 军事 侦察 、 政 
情 勤 测 、 工 业 生 产 、 科 技 教学 与 研究 、 家 庭 服 务 和 医疗 等 领域 得 到 广泛 的 应 用 ， 同 时 ， 以 新 
型 节 胶 机 右 人 为 代表 的 高 性 能 仿生 机 问 人 ， 有 共有 在 和 家庭 机 械 老 物 娱 乐 机 器 人 和 科技 馆 开 展 科 
普 教 育 活动 等 方面 广阔 的 应 用 前 景 。 

最 后 附 上 部 分 零 部 件 的 机 械 图 样 ， 分 列 如 图 4-36 一 几 4-39 所 示 。 
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技术 要 求 : 

1. 楼 边 倒 钝 ， 去 毛刺 ， 

2. 未 注 圆 角 为 R0.S; 

3. 未 注 倒 角 为 C0.5; < 
4. 材料 表面 阳极 氧化 处 理 《本色 ) ; 
5. 未 注 明 尺寸 公差 按 IT10 处 理 。 
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技术 要 求 : 

1. 棱 边 倒 钝 ， 去 毛刺 ; 

2. 未 注 圆 角 为 R0.5; 

3. 未 注 倒 角 为 C0.5; 

4. 材料 表面 阳极 氧化 处 理 ( 本 色 〉; 
5. 未 注 明 尺寸 公差 按 IT10 处 理 。 
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技术 要 求 : 

1. 棱 边 倒 钝 ， 去 毛刺 ， 

2, 未 注 圆 角 为 R0.5; 

3. 未 注 倒 角 为 C0.5; 

4. 材料 表面 阳极 氧化 处 理 〈 本 色 ) ， 
5. 未 注 明 尺寸 公差 按 IT10 处 理 。 


图 4-38 ”电流 电动 机 外 过 


直流 电动 机 外 元 


设计 | 吴迪 | | 
审核 | 罗 庆 生 | | 


数量 | 10 | | | 
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比例 2.000 


1. 棱 边 倒 钝 ， 去 毛刺 ， 


2. 未 注 圆 角 为 RO0.5; 

3. 未 注 个 角 为 C0 .5 RE 
4. 材料 表面 阳极 氧化 处 理 〈 本 色 ) ; 数量 | 3 

5. 未 注 明 尺寸 公差 按 IT10 处 理 。 设计 | 吴迪 | | 


审核 罗 庆 生 | ”| 北京 理工 大 学 





图 4-39” 左 腿 后 部 


圳 了 了 党 


Y 兹 塌 猪尾 枉 其 
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第 5 章 新 型 仿生 六 足 机 怖 人 


(第 五 届 挑 战 杯 首都 大 学 生 课外 学 术科 技 作 品 竞赛 一 等 奖 ，2009 年 ) 


作品 研究 9J 衣 景 必 意 义 


目 然 界 中 的 各 种 生物 通过 物 竞 天 择 和 长 期 进化 ， 对 外 界 环境 产生 了 极 强 的 适应 性 ， 在 能 
量 转换 、 运 动 控 制 、 姿 态 调节 、 信 息 处 理 和 方位 辨别 等 方面 表现 出 了 高 度 的 合理 性 ， 已 日 益 
成 为 人 类 开发 先进 技术 疙 备 的 参照 物 。 仿 生机 右 人 便 是 仿生 学 与 机 费 人 和 学 相 结 合 的 产物 ， 通 
过 对 生物 的 性 能 和 行为 进行 模仿 ， 将 其 结构 特征 、 运 动机 理 、 行 为 方式 应 用 于 机 左 人 的 设计 
中 ， 研 制 具 有 东 些 生物 外 部 形状 或 机 能 的 机 器 人 系统 ， 以 提高 机 融 人 的 运动 特性 和 工作 效率 。 
在 2006 IEEE 机 器 人 学 与 仿生 学 国际 学 术 会 议 上 ， 与 会 的 机 器 人 学 专家 指出 ,“ 模 仿生 物 的 号 
体 结 构 和 功能 ， 从 事 生物 特点 工作 的 仿生 机 器 人 人， 有望 代 蔡 传统 的 工业 机 器 人 ， 成 为 未 来 机 
船 人 领域 的 发展 方 辣 ”。 

如 今 ， 对 机 禹 人 的 研究 已 经 从 结构 环境 下 的 定点 作业 中 走 了 出 来 ， 正 在 癌 非 结构 环境 下 
的 目 主 作业 方 癌 发 展 。 据 调 奋 ， 地 球 上 近 一 半 的 地 面 传统 的 轮 陈 或 履带 式 车 辆 不 能 到 达 ， 而 
很 多 足 式 动物 却 可 以 在 这 些 地 面 上 行走 目 如 。 多 足 式 机 器 人 的 运动 方式 具有 其 他 地 面 推进 方 
却 所 不 具有 的 独特 优越 性 能 ， 主 要 表现 在 : 运动 方式 具有 较 好 的 机 动 性 ， 即 具有 较 好 的 对 不 
平地 面 的 适应 能 力 ， 这 一 运动 方式 的 立足 点 是 离散 的 ， 可 以 选择 地 和 面 上 最 优 的 文 撑 点 ， 还 可 
以 通过 松软 地 面 或 路 越 较 大 的 障碍 ; 运动 系统 可 以 主动 隔 振 ， 即 允许 机 身 运 动 轨迹 与 足 峭 运 
动 轨 迹 解 奈 ， 尽 管 地 面 高 低 不 平 ， 机 号 运 动 仍 可 做 到 相当 平稳 ， 多 足 式 机 器 人 在 不 平地 面 和 
松软 地 面 上 的 运动 速度 较 高 ， 而 且 能 耗 较 少 。 因 此 ， 仿 生 多 足 式 机 器 人 在 战地 侦 奋 、 防 灾 救 
险 、 星 球 探 训 等 领域 有 看 广阔 的 应 用 前 景 。 仿 生 多 足 机 右 人 及 其 相关 技术 的 研究 已 成 为 机 噩 
人 研究 领域 的 热点 。 

但 是 ， 纵 观 国内 外 仿生 多 足 陈 机 器 人 的 研究 状况 ， 存 在 如 下 不 足 乙 处 : 首先 ， 片 面 强 调 
外 观 相似 ， 而 忽略 了 功能 仿生 ， 从 而 限制 了 仿生 机 各 人 性 能 的 发 挥 ， 其 次 ， 部 分 仿生 多 是 式 
机 右 人 机 动 性 能 较 好 ， 但 稳定 性 较 兰 再 次 ， 仿 生 多 足 机 器 人 上 所 携 章 的 传 感 探测 设备 抗 干扰 
能 力 震 ， 不 利于 其 在 非 结构 环境 中 作业 。 

针对 上 述 问 题 ， 项 目 组 本 看 “ 目 主 创新 和 技术 集成 相 结合 、 理 论 分 析 与 工程 实践 相 结合 、 
计算 机 仿真 模拟 与 实际 测试 相 结 合 ” 的 原则 ， 设 计 并 研制 了 新 型 仿生 六 足 机 袁 人 。 痢 型 仿生 
六 足 机 右 人 上 只 有 外 观 新 台 、 运 动 灵活 、 隐 贡 性 好 、 稳 定性 高 等 优点 ， 同 时 还 具有 民 好 的 越 障 
和 避 障 能 力 ， 可 适应 复杂 的 非 结构 化 地 形 ， 能 够 实现 目 主 定位 和 目标 识别 ， 在 星球 探测 、 战 
地 侦 碍 和 防 灾 救 险 等 领域 有 痢 广 泛 的 应 用 前 景 。 些 外， 仿生 六 足 机 右 人 是 一 种 集 仿 生 技术 、 
机 械 设计 、 智 能 控制 、 传 感 探测 、 信 息 处 理 等 多 种 学 科 为 一 体 的 新 型 光 机 电 一 体 化 北 置 ， 是 
狐 理 论 、 狐 方法 、 新 技术 探索 和 实现 的 理想 平台 ， 它 所 涉及 的 关键 报 术 、 试 验方 法 和 研究 思 
路 对 其 他 相关 项 目的 研究 也 具有 很 好 的 借鉴 意义 。 因 此 ， 仿 生 六 足 机 右 人 及 其 相关 技术 具有 
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很 蝇 的 理论 研究 价值 和 工程 实现 意义 ， 狐 型 仿生 六 中 机 上 如 人 的 研制 成 功 对 提 融 我 国 仿 生 多 足 
机 各 人 的 整体 研究 水 平 具有 重要 的 推动 作用 。 


作品 概述 





5.2.1 研究 内 容 概述 


新 型 仿生 六 足 机 器 人 的 研究 内 容 主 要 包括 典型 昆虫 观测 试验 、 机 构 设计 、 运 动 学 分 析 、 
智能 控制 和 传 感 探测 。 

1. 典型 昆虫 观测 试验 

对 生物 原型 进行 观察 与 测量 是 新 型 仿生 六 足 机 器 人 设计 的 基础 和 必要 环节 。 通 过 昆虫 观 
测试 验 ， 一 方面 可 以 了 解 昆虫 髓 体 的 组 成 、 各 部 分 的 结构 形式 及 腿 部 关节 的 结构 参数 ， 另 一 
方面 可 以 研究 昆虫 站 立 、 行 走 姿态 ， 确 定 昆虫 在 不 同 地 形 的 步 态 和 位 姿 。 新 型 仿生 六 足 机 器 
人 以 日 本 马 背 蚁 为 模拟 对 象 ， 采 用 高 速 摄像 机 对 蚂蚁 的 躯体 结构 和 运动 特性 进行 了 观测 试验 ， 
获得 的 试验 数据 为 机 器 人 的 结构 设计 和 运动 控制 提供 了 科学 的 依据 。 

2. 机 构 设计 

机 构 设 计 是 新 型 仿生 六 足 机 器 人 研究 的 基础 ， 整 机 机 械 结构 、 自 由 度数 、 驱 动 方式 和 传 
动机 构 等 都 直接 影响 机 器 人 的 运动 性 能 和 动力 性 能 。 该 机 器 人 的 颈 体 采用 变 截 面 六 边 形 结构 ， 
增 大 了 胶 节 活动 空间 ， 提 高 了 运动 稳定 性 ;运动 肢体 采用 关节 式 结构 ， 符 合生 物 形 态 学 要 求 ， 
单 足 模块 整齐 紧凑 ， 提 高 了 其 在 非 结 构 化 环境 下 的 运动 性 能 。 

3. 运动 学 分 析 

新 型 仿生 六 足 机 器 人 运动 学 分 析 的 目的 是 建立 机 器 人 各 个 运动 构件 与 末端 执行 器 空间 位 
置 之 间 的 关系 ， 进 而 建立 各 构件 运动 的 数学 模型 ， 包 括 机 器 人 位 置 的 正解 、 逆 解 运算 及 速度 、 
加 速度 的 分 析 。 通 过 确定 各 构件 的 位 置 和 轨迹 ， 可 确定 机 构 的 行程 或 外 形 尺 寸 ; 通过 确定 各 
构件 的 速度 、 加 速度 等 运动 参数 ， 可 评价 机 器 人 的 运动 学 和 动力 学 性 能 。 

4. 智能 控制 

为 使 新 型 仿生 六 足 机 器 人 能 够 在 不 同 作 业 环 境 中 高 效 地 执行 各 种 不 同 的 作业 任务 ， 必 须 
对 其 运动 控制 技术 进行 研究 。 新 型 仿生 六 足 机 器 人 的 运动 控制 系统 仿照 生物 神经 网 络 的 功能 
结构 ， 采 用 模块 化 分 层 递 阶 式 的 控制 架构 。 整 个 控制 系统 由 上 位 系统 和 下 位 系统 两 层 结构 组 
成 。 上 位 机 采用 笔记 本 电脑 ， 下 位 系统 以 主 控 计算 机 作为 系统 的 “大 脑 ”， 以 总 线形 式 构建 
系统 的 “ 腹 神 经 索 ”， 以 电动 机 控制 句 作 为 系统 的 “运动 神经 元 ”来 驱动 作为 系统 “肌肉 ?” 
的 电动 机 ， 各 种 传感器 作为 系统 的 “感觉 神经 元 ”和 电动 机 控制 器 一 起 接 入 总 线 ， 统 一 配备 
“血液 循环 系统 ” 供电 系统 。 另 外 ， 在 控制 系统 中 综合 应 用 了 多 种 智能 控制 算法 。 

S$， 传 感 探 测 

为 使 新 型 仿生 六 足 机 器 人 具有 良好 的 环境 适应 能 力 ， 更 好 地 完成 侦察 探测 任务 ， 必 须 对 
其 传 感 探测 技术 进行 研究 ， 包 括 传感器 的 选 型 、 多 传感器 信息 融合 算法 研究 等 。 新 型 仿生 六 
足 机 器 人 配备 了 由 多 种 传感器 (如 超声 波 传感器 、 足 端 触 力 传 感 器 、GPS、INS、CCD 摄像 机 ) 
和 红外 成 像 仪 等 组 成 的 探测 系统 。 超 声波 传感器 用 于 感 测 周围 环境 障碍 物 的 信息 ， 足 端 触 力 
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传 感 融 用 于 感知 地 面 信 息 ，GPS 和 INS 实现 机 器 人 的 导航 定位 。 采 用 多 传 感 融 信息 融合 技术 ， 
把 分 布 在 不 同位 置 、 处 于 不 同 状态 的 多 个 同类 或 不 同类 型 传 感 硕 所 捉 供 的 局 部 不 完整 信息 加 
以 综合 ， 提 高 了 探测 系统 的 响应 速度 和 准确 性 。 


5.2.2 ”技术 指标 


1) 长 0.6m， 宽 0.4m， 高 0.15m， 自 重 28kg ( 含 电 池 )。 

2) 携 市 高 清晰 度 大 视 场 摄像 机 、 无 线 通 信 设 备 、GPS 定位 系统 、INS 导航 系统 、 超 声波 
探测 钱 置 和 高 灵敏 度 足 端 压 力 传 感 央 。 

3) 巡航 速度 为 230nh， 最 高 速度 为 500m/h。 

4) 可 攀 爬 坡度 为 13” 的 斜坡 ， 翻 越 130mm 高 的 障碍 。 

5) 作业 时 间 三 1h。 

6) 无 线 通 信和 距离 三 1.3km。 


让 关键 技术 























5.3.1 ”典型 昆虫 观测 实验 


1. 实验 对 象 的 选择 

本 作品 主要 研究 的 是 仿生 六 足 机 器 人 ， 设 计 的 初衷 是 模拟 六 足 纲 昆虫 的 结构 特征 和 性 能 
特征 ， 使 所 研制 的 机 器 人 达到 机 动 灵活 、 高 效 稳定 和 节能 降 耗 的 目的 。 因 此 ， 实 验 对 象 应 该 
是 六 足 纲 昆虫 。 根 据 选 择 仿生 观测 实验 对 象 应 该 遵循 的 几 点 原则 : 实验 对 象 应 与 要 研究 的 内 
容 相 符合 、 实 验 对 象 应 具有 典型 性 、 实 验 对 象 应 具有 良好 的 可 观察 性 和 可 分 析 性 ， 选 择 蚂蚁 
作为 实验 对 象 。 首 先 ， 蚂 蚁 是 一 种 六 足 纲 昆 虫 ， 种 类 繁多 ， 分 布 广泛 ， 易 于 采集 ， 寿 命 较 长 ， 
另外 ， 蚂 蚁 的 体积 和 息 行 速度 有 利于 采用 高 速 摄像 机 进行 实验 数据 的 采集 。 最 终 选 用 日 本 马 
背 蚁 作为 仿生 观测 的 实验 对 象 ， 如 图 5-1 所 示 。 

2. 实验 平台 的 搭建 

采用 美国 MotinXtra HG-TH 100K 高 速 数 学 摄影 机 系统 进行 观察 实验 ， 如 图 5-2 所 示 。 该 
系统 能 同时 将 四 路 图 像 以 最 高 1000f/s (frame per second) 的 速率 采集 并 无 损 保 在， 多 种 拍摄 
触发 方式 有 助 于 方便 地 捕捉 事件 瞬间 变化 的 细节 信息 。 为 了 保证 在 有 限 的 上 曝光 时 间 内 获得 较 
佳 的 影像 数据 ， 为 该 系统 配备 了 多 种 光源 : 侧 光 光源 离 实验 对 象 较 远 ， 采 用 大 流明 调 焦 和 柔 光 
灯 ; 背光 光源 靠近 实验 对 象 ， 采 用 发 光 二 极 管 阵列 提供 均匀 冷光 ; 备 有 手持 新 闻 灯 随时 补 光 。 

恒 湿 、 人 恒温 的 实验 箱 也 是 本 实验 的 关键 硬件 之 一 ， 它 是 实验 对 象 蚂蚁 的 日 常 活动 场所 ， 
也 是 观察 蚂蚁 行为 的 主要 平台 。 不 仅 需要 很 好 的 透 光 性 ， 而 且 要 求 较 高 的 制作 精度 ， 以 便 进 行 精确 
的 观测 。 所 用 的 实验 箱 是 用 有 机 玻璃 制作 的 长 方 体 透明 盒 ， 尺 寸 为 1 5mmx15mmx25mm。 

实验 布局 示意 图 如 图 5-3 所 示 。 在 相互 王 直 的 三 个 轴 向 上 各 安置 一 个 高 速 摄像 头 ， 而 在 
三 轴 的 交点 处 放置 实验 箱 。 在 获得 原始 影像 信息 后 ， 通 过 以 下 工作 获得 可 供 观测 分 析 的 数字 
数据 。 

1) 对 诛 始 视频 进行 包 选 、 分 类 和 整理 。 
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2) 使 用 视频 编辑 软件 ， 完 成 所 担 摄 的 三 段 视 频 信息 的 精确 同步 处 理 。 

3) 利用 软件 捕捉 采集 需求 点 的 像 聚 点 坐标 ， 完 成 模拟 数据 的 数学 化 处 理 。 

4) 利用 三 视图 两 两 之 间 的 相互 映射 和 关系， 校 核 并 换算 已 获得 的 数字 信息 ， 得 到 可 供 分 析 
的 数据 。 

5) 使 用 计算 机 进行 实体 模拟 、 仿 真 。 
和 汪 7 
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图 5-1 实验 对 象 一 一 日 本 马 背 蚁 图 5-2 高速 摄像 机 主要 组 件 
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图 5-3” 实验 布局 示意 图 


3， 己 背 蚊 运动 特性 观测 实验 研究 
考虑 蚂蚁 的 运动 步 态 ， 义 速 直行 的 步 态 无 疑 最 具有 代表 性 。 木 节 























重点 探讨 蚂蚁 在 匀速 直行 时 的 步 态 规律 ， 然 后 研究 蚂蚁 在 转向 时 的 步 
态 以 作对 比 和 参考 。 

采用 如 图 5-4 所 示 的 方式 对 蚊 足 进行 编号 。 通 过 观察 发 现 ， 蚂 蚁 
运动 时 ， 以 足 1、3、5 为 一 组 ， 以 足 2、4、6 为 另 一 组 ， 以 “三 角形 “ 
支架 ”结构 交 蔡 前 进 ， 这 和 一 般 文献 中 所 述 的 结论 相同 。 然 而 ， 当 蚂 ，”。 











蚁 下 问 前 进 时 ， 其 喘 体 轴 线 与 前 进 方 回 始终 保持 一 发， 并 未 出 现 一 般 
文献 中 所 述 呈 “之 ”字形 曲线 前 进 的 现象 。 图 5-4 ”蚂蚁 趾 厅 编 号 
典型 样本 中 的 蚂蚁 体 长 约 为 11.5mm (不 计 昭 蚁 触角 长 度 )， 步 距 约 为 11mm, 行走 速度 约 
为 80mm/s。 图 5-5 为 蚂蚁 样本 连续 行走 两 步 的 步 态 图 ， 观 察 误差 为 t+2ms， 以 足 1 触 地 时 刻 为 
起 始 时 刻 ， 以 第 二 步 摆动 终止 时 刻 为 终止 时 刻 ， 各 段 长 度 表 示 时 间 长 短 ， 段 中 的 数字 表示 时 
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间 ， 单位 为 INS。o 


摆动 相 











7 支 撞 相 








请 行 相 














图 5-5 ”蚂蚁 样本 连续 行走 两 步 的 步 态 图 


经 观察 发 现 ， 蚂 蚁 前 足 (1、6 号 足 )、 中 足 (2、5 号 足 ) 触 地 时 足 端 点 固定 不 动 ， 随 后 
脱离 地 面 迅速 腾空 ， 支 撑 相 与 摆动 相 区 分 明显 ， 而 蚂蚁 后 足 (3、4 号 足 ) 则 不 同 ， 在 足 端 触 
地 时 先 保持 足 端 点 固定 不 动 ， 然 后 贴 着 地 面 滑行 一 段 距离 ， 再 脱离 地 面 进入 腾空 阶段 。 

基于 此 发 现 ， 可 以 这 样 定义 : 蚁 足 触 地 但 触 地 点 不 变 的 状态 称 为 支撑 相 ;， 完 全 腾空 的 状 
态 称 为 摆动 相 ; 触 地 但 触 地 点 会 有 变化 的 状态 称 为 滑行 相 。 滑 行 相 是 支撑 相 与 摆动 相 的 边缘 
状态 ， 既 可 以 认为 它 是 腾空 运动 而 将 其 归 为 摆动 相 ， 也 可 以 认为 它 能 瞬间 触 地 形成 支撑 而 将 
其 归 为 文 撑 相 。 蚂 蚁 在 复杂 地 形 中 能 很 好 地 保持 吴 体 勺 速 平 移 及 在 高 速 运动 中 仍 能 以 极 大 加 
速度 起 动 、 停 止 ， 这 与 滑行 相 的 存在 密 不 可 分 。 

由 图 5-5 可 以 看 出 : 

1) 任意 时 刻 蚂蚁 都 至少 有 三 只 足 看 地 ， 但 仪 有 三 只 足 着 地 的 时 间 极 其 短暂 ， 硅 将 滑行 相 
视 为 文 撑 相 ， 则 可 以 认为 蚂蚁 至 少 有 四 只 足 着 地 。 

2) 蚂蚁 各 足 的 有 和 荷 因 数 各 不 相同 ， 不 仅 与 相 邻 足 不 同 ， 而 且 与 对 称 足 也 不 同 ， 甚 至 前 一 
周期 与 后 一 周期 都 有 所 不 同 。 

3) 蚂蚁 中 足 的 有 和 合 因 数 最 大 ， 其 次 是 前 足 ， 最 小 的 是 后 是 ， 但 即使 是 后 吓 ， 有 何 因数 也 
都 超过 50%。 

经 过 对 大 量 实验 结果 的 比较 与 分 析 ， 可 以 得 到 以 下 结论 : 

1) 1、5 号 足 (2、6 号 足 ) 进入 支撑 相 的 时 刻 相 同 。 

2) 3、5 号 足 (2、4 号 足 ) 脱离 支撑 相 的 时 刻 相 同 。 

3) 1 号 足 (6 号 足 ) 脱离 支撑 相 的 时 刻 与 4 号 足 (3 号 足 ) 进入 支撑 相 的 时 刻 相 同 。 

假设 在 理想 环境 中 以 恒定 速度 前 进 的 蚂蚁 步 态 是 绝对 周期 步 态 ， 各 是 的 有 俩 因数 不 变 ， 
男 外 ， 对 于 昭 蚁 的 各 足 ， 与 其 相应 对 称 的 是 有 相同 的 有 答 因 数 ， 步 态 为 周期 不 规则 步 态 (“不 
规则 ”表示 各 是 的 有 和 伍 因 数 不 相 同 ， 与 具有 单一 有 和 合 因 数 的 “规则 ” 步 态 相对 )。 取 
1B,…;Bo,B…, 人 1! 作为 蚂蚁 步 态 表达 式 ， 其 中 6B，GB (i=1,2,…,6 ) 分 别 为 i 号 足 的 有 和 蓓 因数 


和 相对 相位 ， 则 有 










































































P=pbs, b=ps, bs= pb (5-1) 
由 结论 1) 可 得 
办 = 人 办 ， 内 = 外 (5-2) 
为 向 化 推导 ， 可 令 
9=90;=0 (5-3) 
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同样 由 结论 2) 和 3) 可 得 
ps+06=0, p+9,=p4+0 (5-4) 
和 
Pi=0,, be + =1+0, (5-5) 
由 式 (5-1) ~ 式 《5-5) 可 推导 出 蚂蚁 的 步 态 天 系 式 如 下 
$=0,6 =0.5,6 = -0.5,@, = pb,f =0,6 =0.5 
P=pbe,b,= bs,b;= pb (0.5B<pB<p< Dd (5-6) 
B+ -pb,=0.5 
根据 式 《5-6〉 可 知 ， 一 旦 确定 一 组 是 的 有 和 从 因数 例如 BB， 记 ， 记 〉 中 的 任意 两 个 ， 即 
可 得 到 蚂蚁 的 步 态 表达 式 。 
上 述 样本 中 
B=s62.32%, b=71.74%, b=53.62%, p=60.14%, ps=66.67%, po = 063.7790 














p=0, fp = 50%,， p=13.72%,， @ = 63.11%, 办 =0， Gs = 48.53% 


所 反映 出 来 的 情况 基本 印证 了 式 (5-6)。 

通过 本 实验 可 以 发 现 : 

1) 早期 的 学 者 认为 昆虫 步 态 的 有 和 集 因数 可 以 小 于 0.5， 但 本 实验 表明 蚂蚁 各 是 的 有 和 俩 因 
数 都 不 低 于 50%， 国 外 对 暗 螂 等 昆虫 的 研究 也 印证 了 这 一 结论 。 

2) 申 蚁 的 各 足 并 非 具 有 相同 的 有 茶 因数， 而 是 处 于 周期 不 规则 步 态 ， 各 目的 相对 相位 也 
不 相同 。 与 有 债 因数 大 于 50% 的 三 角 步 态 相 比 ， 不 仅 同 样 傈 证 曲 蚁 运动 的 稳定 性 ， 而 且 在 相 
同 条 件 下 步行 周期 更 短 ， 从 宏观 来 看 ， 运 动 速度 更 高 。 

3) 对 昌 蚁 步 态 的 真实 仿生 并 非 如 传统 认识 所 认为 的 那么 复杂 。 采 用 周期 规则 步 态 时 只 需 
确定 一 个 有 谷 因 数 即 可 确定 步 态 表达 式 ， 而 采用 周期 不 规则 步 态 时 ， 按 照 式 〈5-6) 进行 步 态 
仿生 也 仅 需 要 确定 两 个 有 衙 因 数 即 可 。 

当然 ， 对 蚂蚁 步 态 进行 真实 仿生 时 ， 还 可 考虑 如 何 实现 蚂蚁 后 足 的 滑行 相 。 经 研究 发 现 ， 
曲 蚊 后 足 的 滑行 时 间 昌 然 不 恒定 ， 但 存在 一 定 的 规律 : 3 号 足 〈4 号 足 ) 脱离 滑动 相 进 入 摆动 
相 的 时 刻 早 于 3 写 是 (2 号 足 ) 脱离 探 动 相 进 入 文 撑 相 的 时 刻 。 其 总 义 在 于 蚂蚁 在 1、5 号 足 
(6、2 号 足 ) 即将 无 障碍 地 触 地 时 3 号 足 〈4 号 足 ) 已 完全 抬 起 ， 这 样 不 仅 能 保证 越 障 性 能 ， 
同时 还 能 提高 移动 速度 。 奋 定义 /为 滑动 时 间 与 运动 周期 比 ， 则 有 

0<7Y<1=- (S57) 


可 以 推 师 ， 夯 在 仿生 六 足 机 费 人 的 步 态 规划 中 按照 式 “5-7〉 加 入 滑动 相 ， 则 非常 有 助 于 
提高 机 器 人 的 越 障 性 能 。 

图 5-6 为 以 2 号 足 摆 动 的 初始 时 刻 为 起 点 连续 记录 两 步 的 蚂蚁 转 癌 步 态 图 ， 该 图 显示 了 
蚂蚁 样本 经 过 两 步 完成 一 个 转 癌 的 过 程 。 由 于 蚂蚁 在 低速 转 辣 时 后 足 基 本 上 是 在 地 面 上 滑动 
而 不 易 区 分 滑动 相 和 摆动 相 ， 所 以 在 该 铭 中 将 后 足 的 滑动 相 视 为 摆动 相 。 由 疼 可 匈 ， 蚂 蚁 在 
转 癌 时 速度 大 幅 下 降 ， 与 此 同时 ， 各 足 的 有 衙 因 数 都 有 所 增 大 ， 中 足 有 千 因 数 的 增幅 尤其 显 
车 。 因 此 ， 在 仿生 六 足 机 器 人 的 步 态 规划 过 程 中 ， 如 条 信 鉴 式 〈5-6) 和 式 〈5-7) 反映 出 来 
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的 内 在 规律 ， 在 减 小 运动 速度 的 同时 提高 各 足 的 有 衙 因 数 ， 那 么 加 能 通过 合理 的 足 山 轨迹 规 
划 ， 来 获得 与 蚂蚁 类 似 的 转 问 特性。 

依据 前 人 的 工作 可 知 ， 多 足 机 右 人 的 运动 规划 问题 可 以 转化 为 单 足 足 闫 的 轨迹 规划 问题 。 
目前 用 于 多 足 机 才 人 足 站 轨迹 规划 的 样本 曲线 以 摆 线 、 抛 物 线 和 正弦 曲线 等 牛 多 ， 这 些 曲线 
及 其 相应 的 轨迹 规划 方法 各 有 利 站 。 此 外 ， 采 用 五 次 或 六 次 多 项 式 禹 近 的 方法 来 解决 多 足 机 
信人 的 运动 规划 问题 ， 较 前 述 方法 更 好 ， 但 美中不足 的 是 ， 该 方法 是 完全 从 数学 角度 出 发 推 
































一 确定 多 足 机 器 人 单 足 足 疾 的 运动 轨迹 ， 然 而 如 何 给 定 这 三 点 却 并 未 探讨 。 因 此 研究 蚂蚁 的 
运动 轨迹 规律 有 痢 很 高 的 学 术 价 值 。 

















图 $-6 ”蚂蚁 转 问 步 态 图 


图 5-7 为 蚂蚁 样本 在 两 个 步行 周期 内 位 姿 变 化 的 休 视 图 投影 ， 其 中 不 同 闫 色 的 彩色 后 分 
别 对 应 224ms 的 观测 实验 时 段 内 蚂蚁 的 尖 、 尾 项 后 及 是 1 一 足 6 的 端点 在 从 视 图 上 的 投影 。 厂 
以 垂直 问 上 为 x 轴 正 方 辐 ， 水 平和 同 左 为 y 轴 正方 加 ， 以 右手 定 则 确定 z 轴 正 方 辐 ， 同 时 以 曲 蚁 
头 、 尾 顶点 在 =0 时 刻 的 投影 为 坐标 原点 , 即 可 绘制 蚂蚁 头 、 尾 顶点 轨迹 沿 各 轴 疝 的 投影 曲线 ， 


如 图 5-8 所 示 。 
一 一 一 头顶 点 x 轴 投影 
-一 一 一 尾 顶 点 x 轴 投影 
_ 头顶 点 y 轴 投影 





-一 尾 顶 点 y 轴 投影 
Pe 头顶 点 z 轴 投影 
a 一 "一 尾 顶 反 z 轴 投影 
ims 
图 5-7 ”蚂蚁 头 尾 顶点 及 各 中 端点 的 俯视 图 投影 0 





该 蚂蚁 样本 的 体 长 约 为 12.2mm〔 不 计 蚂 蚁 触角 长 度 )， 步 距 约 为 10.2mm， 行 走 速度 约 为 
87.6mm/s。 耕 以 蚂蚁 头 尾 连 线 的 中 后 为 相对 坐标 系 原 扣 ， 则 其 头 、 尾 项 扣 及 是 1 一 足 6 的 站 点 
在 相对 坐标 系 中 的 轨迹 曲线 如 图 5-9 所 示 。 
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图 5-9 蚂蚁 头 尾 顶点 及 各 足 端 点 在 相对 坐标 系 中 的 轨迹 曲线 

在 对 各 点 轨迹 进行 曲线 拟 合 时 ， 分 别 
使 用 了 多 项 陈 拟 合 、 高 斯 曲线 拟 合 、 正 弦 
曲线 拟 合 、 平 滑 样 条 拟 合 等 拟 合 方法 。 以 














2 号 足 为 例 ， 它 沿 》 轴 向 的 位 移 曲线 的 拟 看 2 

5-10 和 表 5-1 所 示 。 可 以 看 人 es 
,平滑 样 条 曲线 拟 合 的 效果 最 好 ,但 是 。 “|].-; 声 一 一 二 阶 高 斯 线 

机 遇 线 仅 有 具有 拟 合 功能 ， 不 能 有 效 地 为 “中 光 = 

具体 实际 需求 规划 轨迹 曲线 。 多 项 式 拟 2 50 100 150 200 250 

合 、 高 斯 曲线 拟 合 及 正弦 曲线 拟 合 ， 则 能 ims 

根据 一 定 的 条 件 来 规划 唯一 轨迹 。 经 过 对 图 5-10 2 写 碟 浴 y 轴 辣 的 位 移 拟 合 曲线 


比 可 以 友 现 ， 这 三 种 拟 合 方法 的 拟 和 质量 都 会 随 看 阶 数 的 升 蜗 而 提 蜗 。 为 外 ， 由 三 种 曲线 
的 拟 合 系 数 可 以 看 出 ， 由 3n 个 已 知 条 件 可 以 唯一 确定 3n 阶 多 项 式 曲 线 或 者 n 阶 局 斯 曲线 
或 者 n 阶 正弦 曲线 ， 而 在 拟 合 效果 上 ，3n 阶 多 项 式 曲 线 要 远 远 好 于 阶 蜗 斯 曲线 和 阶 正 
弦 曲 线 ， 所 以 多 项 式 曲 线 是 效果 最 理想 的 拟 合 曲 线 和 规划 曲线 。 由 表 5-1 中 多 项 式 拟 合 结 
末 的 对 比 可 知 ， 六 阶 多 项 式 曲 线 的 拟 合 质量 已 经 很 高 ， 更 高 阶 的 多 项 式 曲 线 拟 合 对 于 拟 合 
质量 的 提升 已 不 明显 ， 相 应 的 计算 量 反 而 大 幅 增 加 。 因 此 ， 采 用 六 阶 多 项 式 曲 线 拟 合 蚂蚁 
是 病 的 运动 轨迹 是 较为 合理 的 方法 。 
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表 5-1 2 号 足 沿 y 轴 向 位 移 曲 线 拟 合 方法 及 效果 


> _ p(t)) Wn p"(D dt 最 小 为 拟 合 条 件 Be 


由 图 5-8 可 以 得 出 如 下 规律 ， 蚂蚁 在 平坦 路 和 面 上 直线 前 进 时 ， 骤 干 的 速度 均匀 ， 没 有 全 
位 、 倾 履 或 者 旋转 等 现象 出 现 。 依 据 此 规律 ， 可 将 蚂蚁 支撑 相 各 是 的 是 剖 运 动 视 为 匀速 后 退 ， 
这 样 可 对 蚂蚁 文 撑 相 各 足 的 足 痪 轨迹 点 进行 线性 拟 合 ， 而 对 摆动 相 各 足 采 用 六 次 多 项 式 拟 合 
对 应 的 拟 合 曲线 为 








PCD= 了 ct (支撑 相 时 关 =1， 摆 动 相 时 m=6 ) (5-8 ) 


i=0 


式 中 ，pl 思 =[xX(D，YD，zkD] 表示 随时 间 变 化 的 足 端 轨迹 矢量 ; c; 为 多 项 式 系数 。 
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由 图 5-8 和 图 5-9 还 可 以 得 出 如 下 另外 三 条 规律 : 

1) 晤 蚁 各 足 步 距 相同 ， 并 且 每 对 对 称 足 的 落地 点 在 轴 方 同上 均 相 差 半 个 步 距 。 

2) 处 于 同 侧 的 前 足 与 中 足 落 地 点 的 轴 坐 标 相 同 。 

3) 蚂蚁 各 足 轨 迹 曲 线 的 形状 相同 (后 足 在 xOy 平面 上 的 轨迹 投影 近似 为 直线 )。 

根据 规律 3) 选择 蚂蚁 的 $ 号 中 足 的 轨迹 做 进一步 分 析 ， 通 过 求 导 获得 其 速度 、 加 速度 的 
曲线 如 图 5-11 所 示 。 由 图 5-11 可 见 ， 速 度 和 加 速度 的 变化 幅度 都 很 小 ， 曲 线 也 相对 平滑 。 








位 置 /mm 





加 速度 / (mm/ms?) 速度 / (mm/ms) 


t/ms 


图 5-11 中 足 足 痕 位 移 、 速 度 和 加 速度 曲线 

采用 六 阶 多 项 式 曲 线 进 行 足 端 轨 迹 规 划 ， 无 疑 没 有 高 宽 比 、 起 角 、 落 角 等 指标 上 的 限制 ， 
可 以 根据 具体 环境 规划 出 满足 需求 的 曲线 。 根 据 对 蚂蚁 运动 数据 的 统计 与 分 析 结 果 发 现 ; 蚂 
到 在 平坦 路 面 上 直线 前 进 时 ， 可 采用 六 阶 多 项 式 拟 合 其 足 应 轨迹， 步 距 为 颈 体 长 度 的 85%， 
高 宽 比 约 为 0.3:1， 足 端 轨 迹 曲 线 所 在 的 平面 与 水 平面 夹 角 为 60°。 

为 了 考 穴 蚂蚁 的 越 隐 性 能 ， 观 测 实验 中 模拟 了 两 种 障碍 物 情况 一 一 平 铺 障 但 柱 及 扒 登 障 
但 柱 。 蚂 蚁 的 运动 截图 如 图 $-12 一 图 5-15 所 示 。 图 5-12 显示 了 样本 蚁 沿 障碍 柱 前 进 时 的 姿 
态 ; 图 5-13 显示 了 样本 蚁 跨越 障碍 柱 时 的 姿态 ; 图 5-14 显示 了 样本 蚁 在 障碍 柱 堆 上 前 进 时 
的 姿态 ， 图 5-15 则 显示 了 样本 蚁 跨越 障碍 柱 堆 时 的 整个 过 程 。 

由 上 述 四 个 典型 样本 可 以 友 现 ， 昭 蚁 在 应 对 两 种 障碍 时 ， 采 取 了 不 同 的 运动 策略 : 

1) 当面 对 高 度 小 于 其 躯体 离 地 高 度 的 障碍 柱 时 ， 昌 及 始终 保持 颈 体 与 地 面 平 行 ， 没 有 出 
现 侧 倾 、 俯 仰 或 翻转 的 现象 。 

2) 当面 对 高 度 大 于 其 躯体 离 地 高 度 的 障碍 柱 堆 时 ， 蚂 明 调 整 位 置 和 姿势 以 保持 躯体 与 障 
但 物 斜 面 平行 。 经 过 进一步 的 实验 观察 发 现 ， 几 乎 在 任何 时 刻 ， 蚂 蚁 的 阴 体 都 平行 于 文 撑 相 
核心 三 足 所 确定 的 平面 (蚂蚁 可 能 会 有 超过 三 只 是 处 于 支撑 相 ， 而 此 处 的 “核心 ”三 足 是 指 
处 于 和 驱 体 一 侧 的 前 是 、 后 足 及 对 侧 的 中 足 )， 甚 至 当 蚂 蚁 倒 甚 于 障碍 柱 时 也 是 如 此 。 


已 已 六 


这 两 种 策略 对 于 仿生 六 足 机 右 人 越 隐 荣 略 的 设计 具有 重要 的 指导 意义 。 
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图 5-12 ”蚂蚁 沿 障碍 柱 前 进 的 三 视图 图 5-13 ”蚂蚁 里 越 障碍 柱 过 程 的 主 视图 及 俯视 图 








图 5-14 ”蚂蚁 在 障碍 柱 堆 上 前 进 的 主 视图 及 休 视 图 


iv 
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图 5-15 ”蚂蚁 跨越 隐 碍 柱 堆 过 程 的 主 视图 





5.3.2 ”机 器 人 结构 设计 


1. 机 器 人 的 机 构 模 型 及 其 自由 度 

机 构 设 计 是 仿生 六 足 机 右 人 系统 设计 的 基础 ， 整 机 机 械 结构 、 目 由 度数 、 张 动 方式 和 传 
动机 构 等 都 会 且 接 影响 机 需 人 的 运动 性 能 和 动力 性 能 。 同 时 ， 仿 生 六 足 机 器 人 机 构 设计 除了 
需要 满足 系统 的 技术 性 能 外 ， 还 需要 满足 经 阐 性 要 求 ， 即 必须 在 满足 机 器 人 的 预期 技术 指标 
的 同时 ， 考 夸 用 材 合理 、 制 造 安 疤 便 捷 、 价 格 低 廉 及 可 乱 性 高 等 问题 。 

仿生 多 足 步 行 机 融 人 的 机 构 由 阴 体 和 腿 部 两 部 分 组 成 ， 其 中 腿 的 数量 及 其 配置 是 整体 设 
计 的 关键 。 现 有 多 足 步 行 机 器 人 的 足 数 包 括 三 足 、 四 足 、 六 足 、 八 足 甚至 更 多 ， 足 的 数目 较 
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多 适合 重 载 和 慢 速 运动 ， 而 足 数 少时 运动 更 加 有 灵活。 影 啊 步 行 机 夫 人 足 数 选择 的 主要 因素 为 : 
稳定 性 、 市 能 性 、 见 余 性 、 关 市 控制 性 能 的 要 求 、 制 造成 本 、 重 量 、 所 需 传 感 带 的 复杂 性 及 
可 能 的 步 态 等 。 腿 的 配置 是 指 步行 机 需 人 的 足 相 对 于 机 体 的 位 置 和 方位 的 安排 ， 确 定 分 布 形 
陈 时 ， 还 需 考 夸 一 些 细 和 问题 ， 如 腿 在 主 乎 面 内 的 几何 构 形 《哺乳 动物 形 、 疏 行动 物 形 、 昆 
虫 形 ) 和 腿 杆 件 的 相对 弯曲 方向 等 。 

在 对 步行 机 器 人 足 数 与 性 能 定性 评价 的 基础 上 ， 上 所 设计 的 步行 机 项 人 采用 六 足 结 构 ， 既 
能 保证 高 速 静态 稳定 行走 能 力 和 负载 能 力 ， 义 阁 夸 了 机 械 结 构 和 控制 系统 的 简单 性 。 通 过 对 
蚂蚁 、 虹 螂 等 昆虫 的 观察 分 机， 发 现 昆 虫 具 有 出 色 的 行走 能 力 和 负载 能 力 ， 因 此 步行 机 器 人 
腿 的 配置 采用 正 同 对 称 分 布 ， 并 且 腿 在 正 主 乎 面 内 的 几何 构 形 采用 昆虫 形 。 仿 生 六 足 机 磊 人 
的 机 构 模 型 如 图 5-16 所 示 。 
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图 5-16 仿生 六 足 机 器 人 的 机 构 模 型 














仿生 六 足 机 磊 人 的 步行 方式 通 冲 采 用 三 角 步 态 。 三 角 步 态 中 ， 六 足 机 器 人 刁 体 一 侧 的 前 
足 、 后 足 与 万 一 侧 的 中 足 共同 组 成 文 撑 相 或 摆动 相 ， 处 于 同 相 的 三 条 腿 的 动作 完全 一 致 ， 即 
三 条 腿 文 撑 ， 三 条 腿 拾 起 换 步 。 拾 起 的 每 条 腿 从 驱 体 上 看 是 开 链 结构 ， 相 当 于 串联 手 尺 ， 而 
同时 看 地 的 3 条 腿 或 6 条 腿 与 肛 体 构成 并 联 多 闭 链 多 目 由 度 机 构 。 步 行 机 右 人 在 正常 行走 条 
件 下 ， 各 文 撑 腿 与 地 面 接触 存在 摩 探 不 打滑 ， 可 以 简化 为 点 接触 ， 相 当 于 机 构 学 上 的 三 目 由 
度 球 面 副 ， 再 加 上 踩 关 节 、 膝 关节 及 通天 贡 《〈 各 关节 为 单 日 由 度 ， 相 当 于 转动 副 )， 每 条 腿 神 
有 6 个 目 由 度 。 

假设 步行 机 器 人 任 一 时 刻 处 于 文 撑 相 的 腿 数 为 Cnz 和 肛 6)， 则 此 时 模型 为 具有 7 个 分 文 的 
空间 多 环 并 联机 构 ， 其 自由 度 可 控 式 5-9) 进行 计算 


p L 
F=f-24-f,-FH+h (5-9) 
i=] i=] 


式 中 p 运动 副 数 ，pP=4n， 

一 一 第 i 个 运动 副 具有 的 自由 度数 ，f;=1 (i=1~3n)，f;=3 (i=3nt+1~4n); 

LL 一 一 独立 封闭 环 数 ，L=n -1; 

4, 一 一 第 i 个 独立 封闭 环 所 具有 的 封闭 约束 条 件数 ， =6; 

了 ,一 一 消极 自由 度数 ，J, =0; 
五 、44 一 一 分 别 为 局 部 目 由 度数 和 重复 约束 数 ， 玉 =0， 如 =0。 

将 以 上 参数 代入 式 (5-9)， 可 得 

F=3n+3n-—(n—-Dx6=6 (S-10 ) 

由 此 可 知 ， 无 论 仿生 六 足 机 二 人 有 儿 条 腿 处 于 文 撑 相 ， 整 个 机 构 是 具有 6 个 自由 大 的 空 
则 多 环 并 联机 构 ， 只 是 有 时 是 3 分 文 并 联机 构 ， 有 时 是 6 分 文 并 联机 构 。 从 机 构 学 角度 看 ， 
仿生 六 足 机 堪 人 驶 是 3 分 文 并 联机 构 、6 分 文 并 联机 构 及 串联 开 链 机 构 之 间 不 断 变 化 的 复合 型 
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机 构 。 同 时 ， 式 5-10》〉 也 说 明 ， 无 论 该 步行 机 占 人 采取 的 步 态 及 地 面 状况 如 何 ， 虹 体 在 一 
定 范围 内 均 可 灵活 地 到 达 任 意 位 置 ， 并 呈现 要 求 的 姿态 。 

2. 机 器 人 本 体 设计 

为 了 便于 加 工 及 安 北 控制 元 占 件 ， 多 中 步行 机 右 人 的 机 体 津 洲 用 箱 形 刚 体 结构 。 通 过 对 
目 然 界 多 足 动物 的 细心 观察 ， 发 现 许多 昆虫 的 腿 的 分 布 情况 往往 如 疼 5-17 所 示 ， 足 部 大 多 落 
在 图 中 椭圆 范围 内 。 因 此 ， 仔 细 研 究 了 机 需 人 立足 点 在 水 平面 上 的 铅 垂 投影 点 构成 的 文 撑 图 
形 ， 以 寻找 其 中 的 原因 。 


























图 5-17 昆虫 足 部 位 置 示意 图 

为 了 行走 稳定 起 见 ， 仿 生 六 足 机 右 人 在 行走 过 程 中 ， 机 体重 心 的 投影 必须 沙 在 三 条 文 择 
足 的 文 撑 点 所 构成 的 三 角形 区 域内 ， 因 为 当 重 心 靠近 边界 时 ， 会 使 机 器 人 的 稳定 性 急剧 降低 。 
童心 投影 到 支撑 图 形 边界 垂直 距离 的 最 小 值 定义 为 稳定 裕 量 ， 因 此 关键 问题 是 如 何 设计 机 体 
形状 才能 保证 其 获得 最 大 的 稳定 容量 ， 即 获得 最 佳 稳定 性 能 。 对 机 体 为 长 方形 和 近似 委 形 的 
网 种 步行 机 器 人 进行 了 运动 学 仿真， 两 种 机 体 对 应 的 文 撑 三 角形 分 别 如 图 5-18 和 图 5-19 所 
示 ， 仿 真 结果 表明 近似 答 形 机 体 的 步行 机 器 人 具有 两 方面 明显 的 优势 : 一 是 减少 了 腿 部 之 间 
的 碰撞 ; 二 是 增加 了 机 体 的 稳定 性 。 


















































图 5-18 长 方形 机 体 对 应 的 文 撑 三 角形 图 5-19 ”近似 缕 形 机 体 对 应 的 支撑 三 角形 


因此 , 在 设计 仿生 六 足 机 器 人 的 机 体 时 ， 采 用 
了 近似 椭圆 形 的 框架 结构 , 除了 以 上 两 方面 的 优势 
外 ， 还 增 大 了 机 器 人 腿 部 的 转动 空间 。 制 造 时 ， 机 
器 人 的 机 体 使 用 高 强度 铝 合金 为 原料 ， 以 减轻 机 器 
人 重量 。 阴 体 内 部 预 留 安 闭 衬 间 及 安 闭 孔 ， 便 于 控 
制 元 器 件 、 视 觉 系 统 、 电 源 模块 等 的 安装 及 走 线 。 
同时 ， 因 该 机 器 人 六 条 腿 的 根部 与 机 体 相连 ， 还 需 
考虑 整体 布局 与 安装 定位 。 图 5-20 为 仿生 六 足 机 | 
器 人 机 体 的 三 维 实体 模型 。 图 5-20 ”仿生 六 足 机 器 人 机 体 的 三 维 实体 模型 
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3. 机 器 人 腿 部 设计 

腿 部 机 构 是 机 器 人 的 重要 组 成 部 分 ， 也 是 仿生 六 足 机 堪 人 机 械 设 计 的 关键 乙 一 。 腿 机 构 
设计 的 基本 要 求 可 以 归纳 为 以 下 三 点 : 

1) 实现 运动 的 要 求 : 从 步行 机 如 人 的 行走 性 能 出 发 ， 一 方面 要 求 机 体能 走出 直线 运动 轨 
迹 或 平面 曲线 轨迹 ， 另 一 方面 要 求 能 够 灵活 转 癌 ， 因 此 腿 的 机 构 应 为 不 少 于 三 个 目 由 度 的 罕 
间 机 构 ， 并 且 足 问 应 具备 一 个 实体 的 工作 空间 。 

2) 承载 能 力 的 要 求 : 机 器 人 的 腿 在 行走 过 程 中 交 和 其 地 支撑 机 体 的 重量 并 在 负重 状态 下 推 
进 机 体 问 前 运动 ， 因 此 必须 具备 与 整 机 重量 相 适 应 的 刚性 和 承载 能 

3) 结构 实现 和 方便 控制 的 要 求 : 从 结构 设计 的 要 求 看 ， 腿 部 机 构 不 能 过 于 复 杀 ， 杆 件 过 
多 会 导致 结构 庞大 和 传动 困难 。 

通过 仿生 观测 实验 可 知 ， 上 自然 界 中 昆虫 的 腿 部 结构 大 致 如 网 5-21 所 示 ， 基 节 、 股 节 
和 上 肥 和 三 部 分 分 别 经 看 跟头 和 节 、 冕 关 和 和 腑 关 布 做 单 目 由 度 旋转 运动 ， 属 于 一 个 RRRS 型 
开 链 机 构 。 采 用 相似 的 三 自由 上 度 关 市 式 腿 机 构 ， 所 设计 的 仿生 六 足 机 器 人 的 腿 部 结构 如 图 
5-22 所 示 。 各 关节 由 电动 机 、 减 速 右 和 锥 具 轮 共同 驱动 ， 以 便 用 简单 的 结构 获得 较 大 的 工 
作 空 间 和 有 灵活 度 。 通 过 控制 相应 关节 电动 机 的 运动 使 机 器 人 有 其 备 了 18 个 目 由 上 度 ， 能 够 实 
现 机 器 人 步行 足 在 可 达 域 内 任意 一 点 的 目 由 定位 ， 在 绪 构 上 保证 了 能 够 有 效 地 模拟 昆虫 的 
行走 方式 完成 相对 复杂 的 运动 。 仿 生 六 足 机 堪 人 整 机 虚拟 样机 模型 和 原理 样机 分 别 如 图 
5-23 和 图 5-24 所 示 。 
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足 端 触 力 传感器 


图 5-21 昆虫 的 腿 部 结构 图 5-22 仿生 六 是 机 右 人 的 腿 部 结构 





图 5-23 ”仿生 六 足 机 器 人 虚拟 样机 图 5-24 仿生 六 足 机 器 人 原理 样机 


第 5 章 ”新 型 仿生 六 足 机 器 人 


5.3.3 ”机 器 人 运动 学 分 析 


1. 机 器 人 的 位 置 分 析 

对 机 右 人 进行 运动 学 分 析 ， 必 须 建立 机 器 人 各 部 件 之 间 、 机 器 人 与 周围 环境 之 间 的 运动 
关系 ， 用 于 描述 机 右 人 的 操作 ， 即 要 规定 各 种 坐标 系 来 描述 机 器 人 与 周转 环境 的 相对 位 姿 关 
系 。 总 的 来 说 ， 这 些 举 标 系 包括 了 绝对 坐标 系 和 相对 坐标 系 两 种 ， 机 右 人 的 绝对 坐标 系 即 大 
地 坐标 系 ， 是 建立 在 工作 现场 地 面 上 的 坐标 系 ; 机 器 人 的 相对 坐标 系 则 有 疆 体 坐标 系 、 关 市 
坐标 系 和 足 端 坐标 系 等 。 

(1) 摆动 相 各 腿 位 置 分 析 ”仿生 六 足 机 堪 人 行走 过 程 中 ， 处 于 摆动 相 的 各 条 腿 相 当 于 机 
械 手 臂 ， 即 从 根 关 和 开始 由 依次 串联 的 腿 节 构成 ， 因 此 求解 各 条 腿 上 驱动 关节 与 足 问 的 关系 ， 
驶 要 确定 各 腿 和 之 间 的 相对 运动 和 位 姿 关系 。 首 先 ， 根 据 Denavit-Hartenberg 方法 在 各 腿 世 下 
闹 《 天 节 处 ) 固 结 一 个 坐标 系 ; 然后 ， 用 变换 矩阵 建立 相 令 两 腿 节 之 间 的 相对 位 姿 天 系 ; 最 
后 ， 将 各 变换 矩阵 相 乘 就 得 到 驱动 天 市 转角 与 足 靖 位 姿 的 关系 。 

仿生 六 是 机 器 人 的 运动 学 正解 是 已 知 机 器 人 戏 体 的 位 姿 和 各 腿 驱 动 天 市 的 转角 来 求解 机 
器 人 足 端 的 运动 规律 。 岁 5-25 表示 出 了 仿生 六 足 机 器 人 腿 部 的 D-H 坐标 系 ,， 各 坐标 系 的 原点 
O; 为 天 而 轴线 5 与 相 邻 天 市 间 公 王 线 qj 的 交点 ，xi 轴 与 公 王 线 qj1,; 和 曾 合 ，z; 轴 与 关节 轴线 
Si 重合， 而 六 轴 可 以 用 右手 螺旋 法 则 来 确定 。 图 中 ，0 、0, 、2 .分别 表 示 根 关节 、 髋 关节 和 
膝 关 节 的 转角 ，4 表 示 基 节 中 心 线 与 根 关 贡 轴 线 之 间 的 夹 和 朋 ，1、P、5 分 别 表示 基 节 、 股 节 和 
脸 节 的 长 度 。 当 腿 部 坐标 系 被 规定 后 ， 就 得 到 了 各 腿 节 的 音量 参数 ， 见 表 S-2。0 为 关 而 转角 ， 
5 为 腿 贡 长 度 ，w, 为 关 币 轴线 的 扭 角 ， 灰 为 公 王 线 之 间 的 距离 。 
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图 5-25 ”仿生 六 足 机 器 人 腿 部 的 D-H 坐标 系 示 意图 
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根据 相 邻 两 关节 坐标 系 之 间 的 转换 和 窍 阵 


coOSO -SnOcosw SmnOSmnw acosO 
,1 |SmnO cosOcosw -cos0O sinQ, 0SmLC 
一 (5-11) 
0 sin C COS C d, 
0 0 0 1 
将 上 述 D-H 参数 代入 ， 可 求 得 相 邻 天 市 坐 标 变 换算 阵 为 
cos@O 0 sin@ Asn4cosO 
ee sinO 0 -cosO [sinAsinO Ee 
' | 0 1 0 -1 cosh1 
0 0 0 1 
cos@, -sin@, 0 bcosl, 
sin@, cost 0 bsing 
Bl 0 (5-13) 
0 0 1 0 
0 0 0 1 
cosO -sn 0 bcosl 
Sn 和 cos 0 Lsing 
4; 三 > 2 ” . ( S$S—14 ) 
0 0 1 0 


0 0 0 1 


以 根 关 市 处 坐标 系 作为 基 坐 标 ， 将 相 邻 关节 变换 窍 阵 相 习 ， 即 可 得 到 是 闹 固 联 华 标 系 的 
转换 答 阵 为 














n. 0. ad. XA, 

Y 
Po A pp og Ca 

n, 0, a, Lv 

0 0 0 1 

因此 ， 由 式 “5-15) 可 得 到 机 右 人 足 丧 位 置 坐标 为 

IX, FZ Y=4440 001 (5-16) 
X,=cosO(hcostO +O)+l, cost, +l sind) (5-17) 
Y=sinQ(lcos(O, +0)+1, cost, +l sint) 45-18 ) 
Z,=bsin(O +0)+l, sinO, -Acos14 《5S-19 ) 
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仿生 六 足 机 器 人 的 运动 学 逆 解 是 已 知 赐 体 的 位 姿 和 足 姗 的 位 姿 求解 处 于 摆动 相 各 张 动 关 
节 的 转角 ， 这 里 采用 逆 变 换 矩 阵 左 乘 方程 两 边 的 方法 ， 将 关 世 变量 分 离 出 来 ， 从 而 求 得 天 蔬 
转角 。 可 以 由 (4 六 号 = 少 省 求 得 ， 且 转角 9, 、2, 的 取 值 根据 实际 情况 验证 确定 。 
0 =arctan(Y, 2 (5-20) 











Z, +li cosh C+1 +l; 一 六 
一 一 一 -一 一 +arccos 一 -一 一 
LO D1 Cy 


CH 


0, = arcsln (S-21 ) 


0, = 一 arccos 一 -一 一 一 一 (CS-22 ) 
2 
其 中 
C=X?+Y+2 -2 /XY +Y? sin4+212, cosA (3=23> 


(2) 文 撑 相 各 腿 位 置 分 机 ”仿生 六 足 机 融 人 行走 过 程 中 ， 处 于 文 撑 相 的 各 腿 与 驱 体 构成 
了 并 联 多 环 机 构 ， 此 时 已 知 文 撑 相 各 腿 的 关节 转角 求解 驱 体 的 位 置 姿态 属于 并 联 多 环 机 构 正 
解 问题 ; 反 乙 ， 已 知 入 体 的 位 置 姿 态 求 解 文 撑 相 各 腿 的 关节 转角 ， 则 属于 并 联 多 环 机 构 逆 解 
问题 。 

首先 ， 在 机 带 人 肢体 中 心 位 置 建立 一 个 固 联 坐标 系 ， 则 里 体 的 运动 便 可 以 用 固 联 坐标 系 
相对 于 大 地 坐标 系 的 位 置 姿 态 变 换 和 矩阵 表示 


coSWcosO cosGsinOcosy -sinGcosy cos@sinOcosy +singsiny xX, 








ee snfGcosO sinGsinOcosy +cosGcosy singsinOcosy —cosGsiny Y, ee 
和 一 SImnO coSOSIn coOSOcosy Z 
0 0 0 1 
式 中 ，XX;。、 了 , 、2, 为 机 器 人 最 体 毕 标 系 原点 在 大 地 坐标 系 中 的 坐标 ， 用 以 表示 沿 大 地 
坐标 系 三 轴 正 疝 移 动 的 距离 ，0 、 乡 、VY 为 绕 三 轴 正 癌 的 转角 ， 用 以 表示 绒 体 姿态 的 变化 。 
同时 ， 秘 体 的 运动 也 可 以 用 固 联 坐标 系 了 Y、 2Z 三 轴 正 向 单位 矢量 N= Cnn),n)， 
0=(0w0,0.) ，4=(4w4,42) 在 大 地 坐标 系 内 的 投影 来 表示 ， 又 有 


Pp 





T, = ， z, (3 
0 0 0 1 
在 给 定 机 髓 人 文 撑 相 各 腿 的 关节 转角 后 ， 各 关节 之 间 的 变换 窍 阵痛 为 已 知 ， 则 有 
[Xx, YY Z 二 =7440443[0 0 01] (5-26 ) 





式 (5-26) 的 左 端 [和 工 Z 下 表示 足 端 的 绝对 坐标 ， 为 给 定 的 已 知 条 件 ; 等 式 右 端 
除 7, 外 ， 其 余 各 项 用 [jv w 下 表示。 其 中 ，44 为 根 关 节 坐 标 系 与 躯体 坐标 系 之 间 的 变 
换 和 矩阵 ， 假 设 着 地 腿 i 根 关节 坐标 是 CX0 ,7 ,Zo ) ， 则 有 
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1 0 0 xX? 


A 
0 0 1 
0 0 0 








当 1、3、5 写 腿 看 地 时 ， 对 应 是 病 位 置 的 坐标 可 分 别 以 CX， 2 


将 以 上 三 是 的 对 应 方程 联 立 后 可 得 





A 


AX! XA, 5 A 
六 jy .1 V 
1 3 下 7, 1 
4 L3 4; 2 
] ] ] ] 


式 (5-28 ) 右 端 各 列 [4 YY 


CO 





0 1 0 Yo 
0 


= 


1 


1 (1=] 》 3 ,5) 表示 ， 


Hs 


(5S—28) 





， 1] G4=1,3,5) 分 别 含 有 各 对 应 足 紧 邻 饮 体 的 关节 转角 01、 


01、01， 这 些 转 角 为 引入 中 间 位 置 量 。7; 中 含有 表示 服 体 位 姿 的 六 个 独立 变量 〔 待 求 )。 对 








应 于 式 《5-28) 中 有 9 个 代数 方程 , 9 个 位 置 量 , 理论 上 是 可 解 的 , 但 使 用 第 规 方法 难以 自 效 。 


这 里 ， 可 作 如 下 人 处理: 


先 列 出 如 下 公式 : 
A A A tH Hs Hs 0 
A A 4 Vv Vs V 0 
0 (5-29) 
pA 2 必 由 由 由 0 
] ] ] ] 1 1 1 1 
th Ms Hs 0 
ee HW lh 
而 式 《5-29) 若 要 有 解 , 需 有 OQ=|  ” 为 非 奇 异 阵 5 即 人 = 访 、， 入 为 
WU 0 0 
OW WwW WwW 
1 1 ] 1 
非 奇 异 阵 ， 此 时 可 设 
R R R 0 
0 SS SS 0 
人 (5-30 ) 
本 
各 上 1 
则 有 
XT XX, XTX, \(R R R 0 Wy. SQ, “0; 
YY % ¥ SS S$ SS 0| », ln oo a, 也 
=7/;, = (S$-31 ) 
2 2 n, 0, da, Z, 
] ] ] 1/ 0 0 0 1 0 0 0 1 





由 此 即 可 求 出 仿生 六 足 机 器 人 的 服 体 位 置 和 姿态 。 同 样 ， 己 知 园 体 的 位 置 姿 态 ， 根 据 以 





上 公式 也 可 以 求 出 机 如 人 文 撑 相 各 腿 的 关 市 转角 。 
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2. 机 器 人 的 速度 分 析 

要 实现 对 机 器 人 的 精确 控制 ， 只 了 解 位 置 参数 是 不 够 的 ， 还 需要 对 其 运动 参数 进行 分 析 。 
运动 分 析 是 在 已 知 机 器 人 的 机 械 绪 构 和 几何 斥 寸 的 条 件 下 ， 建 立 其 运动 参数 之 间 的 运动 关系 
式 ， 包 括 速 上 度 分 析 和 加 速度 分 析 两 个 方面 。 由 于 加 速度 分 析 与 速度 分 析 类 似 ， 在 这 里 仅 对 机 
嫌 人 的 速度 进行 分 析 。 

可 参照 机 才 人 位 置 分 析 的 方式 对 机 器 人 进行 速度 分 机 ， 这 可 分 两 步 完 成 。 首 移 按 串联 机 
构 对 机 器 人 摆动 相 各 腿 进行 速度 分 析 ， 然 后 再 对 阴 体 和 文 撑 相 各 腿 组 成 的 并 联 多 环 机 构 进 行 
速度 分 析 。 

(1) 摆动 相 各 腿 速 度 分 析 “由 仿生 六 足 机 器 人 位 置 天 系 的 分 析 可 以 获得 摆动 相 足 痛 空 间 x 与 
天 广 空 间 g 的 位 移 关 系 x= xCq) ， 将 其 两 边 对 时 间 t 求 导 ， 即 可 得 到 

X=J(g) 9 (3532) 

式 中 ， 庆 为 中 问 空 间 的 广义 速度 9 为 天 市 速 有 度 ; 7(9) 为 雅 可 比 窍 了 泗 ， 它 是 串联 机 构 上 
某 点 的 速度 与 天 广角 速度 的 线性 变换 ， 也 可 以 看 成 从 关 市 空间 问 足 喘 空间 运动 速度 的 传动 比 ， 
其 第 1 行 第 列 元 素 为 















































OX,(qg) . | 
0 (S$S—33) 


仿生 六 足 机 需 人 腿 部 有 3 个 天 市 ， 其 雅 可 比 沧 阵 Aq) 是 6x3 阶 和 矩阵 ， 前 3 行 代表 足 闪 线 
速度 v 的 传动 比 ， 后 3 行 代表 足 端 角速度 ow 的 传动 比 ， 所 以 足 端 速度 可 以 表示 为 














ql ql 
Vy i 坟 J 
=Ja)o,|=| ?2 “|e (S-34 ) 
电 ww J a 4 
d3 243 





般 说 来 ， 我 们 需要 的 是 机 器 人 足 端 在 空间 的 线 速 度 ， 因 此 只 求 出 线 速度 的 雅 可 比 和 矩阵 
-sing [lcos(0, +0,)+1,cosO, +l sinA|cosO [-1 sin( 0, +0,)—1, sinO, |cos0 [-1, sin( 0, +0,)] 
cos [lcos(O, +0,)+1, cosO, +lisinA|sinO [-1 sin( 0, +0,)—1, sinO, |sinO [-1, sin( 0, +0,)]| 
0 Lcos(0, +0,)+1L, cosD 1, cos( 0,+0,) 
从 式 《5-35) 可 以 看 到 ， 雅 可 比 算 阵 只 与 机 器 人 的 运动 学 尺寸 、 机 构 的 类 型 及 机 构 的 位 
置 有 关 ， 即 与 机 构 的 位 形 有 关 。 由 此 ， 可 得 出 仿生 六 足 机 器 人 足 端的 线 速度 为 
0 
v=J(9)| 0 (5-36) 
0 
有 反之 ， 己 知 机 器 人 足 端 的 线 速度 也 能 求 得 其 转动 关 市 的 速度 ， 以 应 用 于 机 器 人 的 控制 ， 
即 有 





J1(9)= (S-35) 














q = J qv (S$-37) 
(2) 文 撑 相 各 腿 速度 分 析 “仿生 六 足 机 器 人 行走 时 ， 所 形成 的 并 联 多 环 机 构 是 由 者 干 分 
文 及 中 心平 台 组 成 的 ， 可 首先 分 析 其 中 的 一 个 分 文 ， 即 一 条 腿 的 串联 运动 链 。 该 串联 运动 链 
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从 足 端 到 根 关 包括 了 3 个 转动 副 和 一 个 球 副 ， 其 坐标 系 如 图 5-26 所 示 。 图 中 ， 各 运动 副 轴 
线 用 单位 矢量 8 表示; 相 邻 轴线 间 公 法 线 方向 为 单位 矢量 a, ,在 相 邻 公法 线 间 沿 5, 的 偏 距 为 
9 ， 公 法 线 长 度 为 wj ， 转 角 为 86, 。 这 样机 各 人 驱 体 的 角速度 wi 可 以 表示 为 

@,=(G; )¢ (5-38) 














式 中 ，@, =(@。，。 OO%， 0O)，9=( 抽 多 … 搞 ) 为 单 分 支 中 各 个 转角 的 速度 ，(G 是 机 
器 人 躯体 转动 对 分 支 运动 副 变 量 的 一 阶 偏 导 影响 系数 矩阵 ， 且 


一 一 


(6!)=(5 5 (5-39) 


U34 


5 





图 5-26 ” 单 分 文 坐 标 系 

机 器 人 驱 体 上 任 一 参考 点 了 的 线 速 度 v, 可 以 表示 为 
vp=(G; )g (5-40) 
式 中 》 Vp 二 (ve Vp 


， Vp) ; (G7 ) 是 机 器 人 最 体 移动 对 分 支 运动 副 变 量 的 一 阶 影响 系数 
矩阵 


Vp 


Zz 


(G7)=(5 x(B-R) ... Sx(P- RO)) (5-41) 
式 中 ，P 一 R, 表 示 从 第 j 坐标 原点 到 pp 点 的 矢量 ，P 为 氢 体 中 心 在 基础 坐标 系 中 的 位 置 矢 
量 ，R, 为 /坐标 系 与 基础 坐标 系 两 原点 之 间 的 距离 矢量 ， 昌 有 
R=SS +avdy ++S,S, (5-42) 
其 中 5)、 6; 根据 初始 条 件 5 =(0 0 1) 和 t=(cos9@ sing 0) ， 可 由 以 下 递 推 公 
式 经 计算 得 到 ， 即 已 知 








了 =(2 Sxa, 3) (5-43) 
可 有 
0 
S;=T | -sin Qo (S-44 ) 
COS Qj } 
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和 
cos0,; 
qrp = Ti1| 一 cosQo -Dj SInO (5-45) 
sin 0 1D Sin O 1 
将 式 〈5-38) 和 式 〈5-40) 结合 ， 可 得 综合 公式 
v= (Go )6 (5-46) 





3 
CO 
| |-(% Os, Cis Vpe Vp, vo) (S547) 


和 


pi (5-48) 
(Gy), 


其 中 (Gy ) 是 机 器 人 躯体 对 分 支 的 综合 影响 系数 矩阵 。 当 已 知 6 求 得 vs， 为 正解 ， 而 当 已 
知 vi 求 得 9， 则 为 反 解 。 
如 前 所 述 ， 当 仿生 六 足 机 器 人 以 “三 角 步 态 ” 行 走时 ， 为 三 分 支 并 联机 构 。 若 已 知 机 器 
人 躯体 的 运动 ， 则 各 分 支 中 运动 副 的 运动 可 以 写 为 
bp =(G%) 证 r= 2 3 (5_49) 
式 中 , 7 表示 分 支 并 联机 构 的 分 支 序 号 , 且 并 联机 构 上 每 个 分 支 的 影响 系数 矩阵 与 开 链 机 
构 的 形式 相同 。 当 确定 了 此 6 自由 度 机 构 的 6 个 主动 输入 后 ， 从 式 (5-49) 中 将 6 个 主动 运 
动 的 方程 分 别 取 出 ， 可 有 























($5-50) 


= (O07) 
式 中 ，0 为 输入 角速度 ,其 上 角 标 和 下 角 标 分 别 表示 输入 角速度 所 在 的 分 支 序 号 和 分 支 
中 运动 副 的 序号 ，(GY) ”表示 第 a 分 支 的 逆 甜 阵 的 第 Q 行 。 
将 上 述 6 个 方程 结合 构成 矩阵 表达 式 ， 可 有 


4=(G2)w 55 


























式 中 ，4 = (PB&。 tp … 从 ) 是 独立 广义 坐标 ， 且 含 6 个 输入 角速度 的 列 和 撩 ， 而 
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人 二 
—1(b) 
(G7 )= (6 ), (5=52) 
-1(7) 
(co 
于 是 可 以 得 到 他 解 为 
vy =(G7 )g (5-53) 


式 (5-53) 成 立 的 条 件 是 (GY ) 为 非 奇异 阵 。 应 用 式 〈5-51) 和 式 (5-53)， 在 已 知 6 个 广义 
输入 速度 的 条 件 下 ， 可 以 求 得 机 器 人 躯体 的 六 维 速度 ， 也 可 以 由 躯体 的 六 维 速度 求 6 个 广义 
输入 速度 。 这 里 的 一 阶 影响 系数 (Gy ) 是 躯体 运动 对 6 个 广义 输入 速度 的 综合 影响 系数 ， 它 同 
时 与 3 个 分 支 的 18 个 运动 副 的 方位 有 关 ， 也 与 整个 机 构 的 位 形 有 关 。 


5.3.4 ”机 器 人 控制 系统 


1. 机 器 人 控制 系统 整体 方案 

依照 生物 神经 网 络 的 功能 结构 ， 采 用 模块 化 分 层 递 阶 探 制 的 思想 设计 仿生 六 足 机 右 人 的 
控制 系统 染 构 。 整 个 控制 系统 由 上 位 系统 和 下 位 系统 两 层 结 构 组 成 ， 上 位 系统 包括 人 的 参与 ， 
体现 人 的 盖 志 ， 下 位 系统 实现 机 如 人 慌 层 目 主 控制 ， 执 行人 的 意图 。 仿 生 六 是 机 各 人 控制 系 
统 如 图 5-27 所 示 。 上 位 系统 仅 包含 机 希 人 “ 脑 核 ”的 功能 ， 仅 需要 解决 人 机 交互 问题 。 下 位 
系统 则 包括 其 他 所 有 功能 ， 相 对 复杂 ， 所 以 下 面 重 点 介绍 下 位 系统 的 设计 。 

昆虫 的 神经 系统 结构 人 简单、 层次 分 明 、 功 能 齐全 ， 同 时 体现 出 优 民 的 综合 性 能 。 其 原因 
在 于 神经 元 有 痢 功 能 分 化 的 特点 ， 扎 们 各 司 其 职 ， 同 时 具有 有 效 的 艳 合 ， 体 现 出 高 速 的 信息 
传递 机 制 。 因此， 仿生 六 足 机 器 人 采用 如 图 5-28 所 示 的 下 位 系统 结构 :以 主 控 计算 机 作为 系 
统 的 “大 脑 ”"， 选 择优 秀 的 吕 线 形式 构建 系统 的 “ 腹 神 经 索 ”， 从 而 形成 机 姻 人 系统 的 中 枢 神 
经 系统 ; 设计 电动 机 控制 旨 作 为 系统 的 “运动 伸 经 元 ”来 驱动 作为 系统 “肌肉 ”的 电动 机 图 
5-27 作为 示意 图 略 去 了 部 分 电动 机 控制 左 和 电动 机 )， 各 种 传感器 作为 系统 的 “感觉 神经 元 ” 
和 电动 机 控制 右 一 起 接 入 总 线 ， 成 为 整个 神经 网 络 的 一 部 分 ;此 外 统一 配备 另 一 僚 “血液 循 
环 系统 ”一 一 供电 系统 。 下 位 系统 与 上 位 系统 的 通信 类 似 于 昆虫 的 触角 探测 过 程 一 一 触觉 信息 
迅速 传递 到 “大 脑 ”， 而 不 经 过 “ 腹 神 经 索 ”昆虫 的 视觉 、 串 和 觉 等 信息 的 传递 采用 同样 的 路 
人 径 。 整 个 仿生 六 中 机 占 人 控制 系统 其 有 与 昆虫 类 似 的 结构 ， 唯 一 不 同 点 在 于 忆 线 模拟 了 “上 腹 
神经 索 ” 作 为 “信息 局 速 公 路 ”的 传递 特点 ， 但 没有 体现 “上 腹 神经 索 ” 神 经 节 中 联络 神经 元 
的 自主 特点 ， 该 特点 体现 在 电动 机 控制 器 中 ， 即 将 系统 的 “ 腹 神 经 索 ” 中 的 “联络 神经 元 ?” 
放 在 靠近 “运动 神经 元 ”的 位 置 ， 两 者 在 物理 层 上 意义 相同 。 

仿生 六 足 机 需 人 下 位 系统 与 传统 单 CPU 的 集中 控制 系统 的 不 同 在 于 : 仿生 六 是 机 絮 人 的 
各 功能 模块 (包括 主 控 计算 机 ) 都 不 仅 是 系统 的 一 个 端点 , 而 且 是 具有 目 主 性 的 “神经 元 ”( 主 
控 计 算 机 是 “神经 元 群 ”， 功 能 更 为 强大 )， 所 有 神经 元 可 以 通过 总 线 相互 通信 ， 从 而 构成 庞 
大 的 神经 网 络 。 





















































© 


第 5 章 ”新 型 仿生 六 足 机 器 人 





























图 5-27 ”仿生 六 足 机 器 人 控制 系统 
2. 机 器 人 控制 系统 硬件 组 成 
仿生 六 足 机 需 人 控制 系统 采用 上 下 位 机 的 分 层 递 阶 控 制 模 式 ， 其 便 件 系统 结构 如 网 5-28 





所 示 。 系 统 中 ， 下 位 机 采用 基于 PC104 总 线 的 小 型 髋 入 式 计算 机 系统 ， 体 积 小 ， 功 能 强 ， 有 
多 种 数据 卡 可 配套 使 用 ， 主 要 由 CPU 板 、 电 源 板 、A/D 板 、LO 板 、CAN 总 线 接口 板 和 视频 
板 组 成 。 

下 位 机 主板 采用 基于 PC/104-Plus compliant 架构 的 CPU-1461， 板 载 256MB SDRAML 
提供 丰富 的 外 设 接 口 〈 包 括 2 个 串口 、1 个 并 口 、4 个 USB 口 及 1 个 10/100Mb/s 以 太 网 口 
等 )， 其 性 能 能 够 满足 先入 式 应 用 的 基本 要 求 。 另 外 ， 该 板 卡 配置 了 4G 容量 、80 倍速 的 
CompactFlash 卡 ， 替 代 传 统 的 机 械 便 稚 作 为 存储 右 ， 它 不 仅 功 耗 低 、 体 积 小 、 重 量 轻 ， 而 
且 读 写 可 靠 性 高 。 

除了 主板 外 ， 根 据 需 要 选择 了 基于 PC/104-Plus compliant 架构 的 CAN 总 线 接 口 板 
COM-1273 和 视频 采集 卡 CTR-1472。COM-1273 是 以 两 块 Philips SJA1000 控制 器 芯片 为 核心 
的 双 通道 CAN 总 线 接口 板 ， 支 持 CAN2.0B。CTR-1472 是 采用 MPEG-4 编码 的 四 通道 视频 采 
集 卡 ，PAL 压缩 速率 为 352x288 〈100fs 时 ) 或 者 720x576 (25f7s 时 )， 可 将 四 个 摄像 机 捕获 
的 视 /音频 数据 流 进 行 高 度 压缩 ， 并 通过 PCI 总 线 进行 传输 。 

下 位 机 使 用 DC5V 电源 ， 其 对 电压 变化 相当 敏感 。 由 图 5-27 可 见 下 位 机 与 其 他 设备 共用 
能 源 ， 特 别 是 与 电动 机 共 网 ， 而 电动 机 在 运动 中 会 产生 电压 、 电 流 的 变化 进而 影响 全 网 ， 
此 需要 将 下 位 机 与 全 网 隔离 。 为 此 ， 下 位 机 单独 配备 了 功率 为 S0W 的 ACS-5150 稳 压 电源 ， 
该 模块 能 接受 DC8 一 40V 输入 并 保持 恒定 的 DC3.3V、DC5V、DC12V 输出 ， 在 下 位 机 电源 输 
入 新 连接 ACS-5150 即 可 保证 下 位 机 的 可 靠 运行 。 
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上 位 机 一 
ds USB 无 线 网 关 。 
上 位 机 | 遥控 逆 置 下 Pentium4 一 一 志江 信 模 杂 天 线 


笔记 本 电脑 | COM 


图 5-28 仿生 六 足 机 器 人 控制 便 件 系 统 结 构 


上 位 系统 由 操作 者 和 主 探 计 算 机 组 成 ， 相 对 下 位 系统 而 言 其 结构 较为 简单 ， 并 日 其 功能 
需求 也 很 简单 一 一 良好 的 人 机 交互 能 力 及 与 下 位 机 的 通信 和 能力。 上 位 机 采用 Pentiu 4 笔记 本 电 
脑 ， 不 仪 成 本 低廉 ， 而 且 符 合 一 般 操 作者 的 使 用 习惯 。 上 、 下 位 机 之 间 有 采用 无 线 通 信和 系统 进 
行 通信 ， 选 用 了 基于 PCMCIA 接口 形式 的 TL-WN510G 无 线 网 卡 和 基于 RJ-45 接口 形式 的 
WRT54GC 无 线路 由 器 ， 以 实现 300m 距离 范围 内 的 54Mb/s 低 功 耗 、 低 辐射 无 线 通 信 。 控 制 
系统 的 主要 便 件 如 岁 5-29 所 示 。 
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图 5-29 ”仿生 六 足 机 器 人 控制 系统 的 主要 使 件 
在 确定 了 仿生 六 足 机 器 人 的 主要 使 件 忆 后， 需要 考 夸 如 何 将 众多 的 设备 安置 在 有 限 的 空间 
中 ， 同 时 鳞 顾 使 件 平 侣 的 可 该 性 和 后 期 维护 ， 所 以 ， 使 件 系 统 的 电气 工艺 性 要 求 必 然 很 高 。 仿 
生 六 足 机 邵 人 采用 如 图 5-30 所 示 的 电气 图 ,在 电气 工艺 上 具有 特 氮 : GO 各 设备 间 采 用 单一 排 线 
连接 ， 该 排 线 提供 电线 路 和 通信 线路 。 其 中 CAN 总 线 仅 保留 标准 9 针 CAN 总 线 中 的 CAN _H、 
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CAN L 和 CAN _GND 三 针 ; 包 电 源 、 主 探 计算 机 及 其 他 设备 之 间 设 置 供电 屏障 ， 使 各 设备 在 
电源 使 用 上 保持 一 定 的 独立 性 ; (设备 采用 堆栈 式 安装 方式 ， 可 徘 性 蜗 ， 层 次 清晰 ， 通 风 敌 热 
性 好 ;多 所 有 设备 采用 无 风 届 设计 ， 功 耗 低 。 大 发 热量 议 备 的 散热 族 紧 贴 机 喘 ， 利 用 机 堪 人 机 
号 作为 扩展 做 热 记 ;名 便 件 的 合理 布局 保持 了 机 器 人 质量 均衡 ， 同 时 便于 设备 的 控制 和 维护 。 
整套 人 硬件 系统 在 满足 仿生 六 足 机 器 人 功能 要 求 的 同时 ， 很 好 地 兼顾 了 小 体积 、 轻 质量 、 
低 功 耗 、 高 速 运算 、 无 线 操作 、 实 时 通信 、 方 便 扩 展 等 设计 需求 ， 为 仿生 六 足 机 器 人 体现 优 
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图 5-30 ”仿生 六 足 机 器 人 电气 图 


3. 机 器 人 控制 算法 设计 

仿生 六 足 机 器 人 的 仿生 控制 系统 模仿 了 昆虫 的 神经 系统 网 络 ， 设 计 了 “大 脑 ^“ 神 经 元 ” 
及 与 大 脑 分 离 的 “ 脑 核 ”。 围 纸 者 “ 脑 核 “大 脑 ” 和 “神经 元 ”所 分 别 对 应 的 高 层 、 中 层 和 
底层 智能 层次 ， 仿 生 六 足 机 器 人 各 部 分 需要 实现 相应 的 神经 控制 功能 

1) 上 位 机 需 ;要 理解 操作 者 的 高 层 指令 ， 并 完成 相应 的 处 理 任务 。 

2) 下 位 机 需要 完成 蜗 层 指令 解读、 环境 状况 监测 和 压 层 申请 处 理 三 个 主要 任务 。 

3) 电动 机 控制 礁 需 ;要 完成 电动 机 运动 底层 规划 和 电动 机 运动 控制 这 两 个 任务 。 

其 中 ， 中 层 智 能 和 帮 层 智能 的 实现 是 仿生 六 足 机 右 人 实时 在 线 运 动 控制 的 关键 。 

作为 高 层 和 砌 层 的 连接 桥 染 ， 下 位 机 解 该 高 层 指令 并 执行 ， 它 是 仿生 六 足 机 磊 人 实时 在 
线 运动 控制 的 基础 。 在 前 述 的 控制 系统 结构 中 ， 所 有 的 传 感 融 都 与 下 位 机 相连 ， 因 此 下 位 机 
通过 传 感 信息 来 监测 环境 状况 从 而 指导 机 和 幽 人 的 运动 。 作 为 “神经 元 ”的 电动 机 控制 如 能 完 
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成 简单 的 运算 和 控制 作业 ， 但 不 能 在 机 霹 人 宏观 模型 的 基础 上 规划 关节 的 运动 ， 因 此 针对 仿 
生 六 足 机 袁 人 选择 这 样 一 种 思路 : 由 电动 机 控制 左近 出 运动 规划 申请 ， 而 下 位 机 根据 申请 执 
行 运动 规划 。 这 种 思路 不 仅 充 分 发 挥 了 下 位 机 和 电动 机 控制 费 各 目的 便 件 性 能 ， 而 且 便 于 针 
对 机 老人 多 足 的 特 氮 对 其 进行 条 理 清晰 的 运动 规划 ， 仿 生 六 足 机 器 人 基于 醒 型 的 控制 琵 略 也 
体现 在 此 。 

电动 机 控制 右 作 为 “运动 神经 元 ”要 能 很 好 地 驱动 和 控制 电动 机 。 为 外 ， 前 面 所 到 ， 电 
动机 控制 占有 具有 上 腹 神 经 索 的 “联络 神经 元 ”的 功能 。 因 此 ， 电 动机 控制 右 类 似 于 昆虫 的 体 神 
经 节 ， 能 够 完成 电动 机 运动 的 确 层 规划 ， 例 如 关节 的 布 律 运 动 ， 仿 生 六 足 机 右 人 基于 生物 控 
制 的 策略 体现 在 此 处 。 

根据 上 述 任务 描述 ， 基 于 已 经 实现 的 仿生 六 足 机 左 人 的 便 件 平台 ， 设 计 了 如 图 5-31 所 示 
的 运动 控制 算法 体系 。 上 位 机 包括 人 机 交互 界面 和 避 层 指令 收发 器; 与 功能 需求 对 应 ， 下 位 
机 包括 高 层 指令 字典 、 传 感 信 息 栈 和 运动 规划 运 复 库 ， 三 者 相互 衔 氢 ， 互 为 参考 ， 其 中 局 层 
指令 字典 面 癌 上 位 机 完成 指令 映射 ， 而 运动 规划 运算 库 面 回电 动机 控制 右 完 成 电动 机 控制 痪 
提出 的 运 复 申 请 ; 压 层 的 电动 机 控制 占 包 括 步 态 生成 占 和 关 市 控制 占 ， 其 中 步 态 生成 右 模 块 
与 其 他 电动 机 控制 需 的 步 态 生成 堪 醒 块 相 互通 信和 协调 ， 以 完成 机 需 人 时 间 域 的 运动 规划 ， 





















































而 各 个 关 市 控制 占 依 徘 下 位 机 的 运动 规划 运算 库 执行 机 器 人 空间 域 的 运动 。 
rm ey 





传 感 信息 栈 上 一 一 》 





运动 规划 运算 库 


人 人 
0 0 
图 5-31 仿生 六 足 机 器 人 运动 控制 算法 体系 

上 述 算法 体系 层次 分 明 ， 结 构 清 晰 ， 功 能 分 配合 理 ， 宏 观 上 为 仿生 六 是 机 右 人 实时 在 线 
运动 的 实现 商定 了 民 好 的 基础 。 

通过 学 习 昆 虫 的 CPG 机 制 来 实现 机 器 人 的 协调 、 目 然 的 变速 运动 是 一 个 可 行 的 途径 。 从 
工程 的 角度 来 看 ，CPG 神经 电路 可 以 看 作 是 由 一 组 互相 耦合 的 非 线性 振荡 器 组 成 的 分 布 系统 ， 
其 通过 相位 耘 合 实现 节律 信号 的 发 生 ， 而 改变 振荡 器 之 间 的 耘 合 关 系 可 以 产生 有 具有 不 同 相 位 
天 系 的 时 衬 序 列 信和 号， 实现 不 同 的 运动 模式 。 

音 鉴 以 往 在 机 器 人 上 应 用 CPG 机 制 的 正 反 两 方面 的 经 验 ， 基 于 蝶 旺 机 器 人 振荡 器 模型 ， 
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为 仿生 六 足 机 器 人 设计 了 如 图 5-32 所 示 的 CPG 网 络 ， 其 非 线性 振荡 器 的 数学 表达 式 为 
0 =2rm+> PisinCO 一 0 一 内) 


j= SC -二 
4 


y; =x|1- (0 € [2kn,2kn + 26T) 
pT 





(5-54) 








yi =n ee 元 而 0+ hp je e [2kn+2Bn,2(k+1)7) 


7 


Vi =C,5, = min(s,,s, )) 


td,s 


Vv ~ imin imin 
R, = CR Simax + dR Simax = MAaX Sir»5;)) 
b=2.9.-9) 7 


式 中 ， 尺 和 8 分别 为 第 ! 足 的 有 衙 因 数 和 相位 ; sr 为 第 i 个 神经 元 的 外 部 激励 闵 值 。0 和 
»; 分别 代 表 第 i 个 神经 元 的 相位 和 幅 值 ，v; 和 RR 分 别 代表 第 i 个 神经 元 的 固有 频率 和 幅 值 ;a 
为 幅 值 允 近 速度 常数 ，9; 代表 第 i 个 神经 元 和 第 j 个 神经 元 之 间 的 相位 差 ，v; 和 BR 与 外 部 激励 
s; 成 线性 关系 ， 比 例 系数 分 别 为 c 和 ca ， 偏 移 分 别 为 4, 和 dn 。 

该 模型 的 特点 主要 有 : 

1) 突破 “ 屈 肌 一 伸 肌 ”模型 的 限制 ， 并 人 简化 18 个 关节 的 相位 耦合 关系 ， 只 为 6 个 根 关 
节 分 别 设置 一 个 非 线性 振荡 右 ， 组 成 振 沪 环 路 ， 不 仅 大 大 简化 了 模型 ， 而 且 为 模型 在 空间 域 
的 应 用 真 定 了 基础 。 

2) 外 部 激励 强度 与 机 器 人 的 期 望 速度 成 正比 ， 振 荡 需 得 出 近似 为 根基 节 位 移 。 

3) 振荡 器 输出 曲线 函数 引入 了 有 傈 因数 ， 当 旦 处 于 文 撑 相 时 近似 取 和 直线 ， 当 是 处 于 摆动 
相 时 近似 为 余弦 曲线 ， 符 合 足 运动 时 根 关 节 的 运动 特征 。 

4) 模仿 昆虫 运动 ， 当 速度 低 于 某 设 定 浆 值 时 为 变频 不 变 幅 运动 〈 步 行 周期 变化 而 步 长 不 
变 )， 肥 之 则 为 变 幅 不 变频 运动 。 

5) 能 够 生成 满足 要 求 的 不 规则 步 态 。 

上 部 激励 
Ww 三 
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图 5-32 ”仿生 六 足 机 器 人 CPG 网 络 模型 
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取 Ci =2() Gs = 0.], d, = CR 关心: 2 di =—0.5, Si =10(7i=1,2,.…,6) 


以 及 神经 元 连接 权重 窍 阵 


10 0 10 
10 0 10 
10 0 10 
10 10 0 


可 获得 随 外 部 激励 变化 的 各 振 沪 闫 和 输出 曲线 ， 如 图 5-33 所 示 。 
18 人 _ 静止“， 周期 改变 : ” 周期 恒定 ” : ”周期 恒定 


| 
| 有 ， 近似 直线 


上 近似 余弦 曲线 
i et | 


AAA 人 各 | 
中 1 







[> 
un 
NO 
六 
中 





图 5-33 ”各 振 荡 器 输出 曲线 

仿真 结 采 显示 ， 当 期 望 机 器 人 保持 毅 止 时 ， 各 足 的 根 关 世 从 当前 位 置 逐 渐 移 动 到 运动 饭 
始 位 置 ， 然 后 保持 位 姿 直 到 期 望 速度 改变 ， 随 独 期 望 速度 逐渐 提高 ， 根 关节 的 运动 周期 逐渐 
缩小 ， 但 是 周期 内 转动 角度 保持 不 变 ， 同 时 文 撑 相 时 间 较 长 ， 其 关节 运动 近似 为 直线 ， 而 把 
动 相 时 间 较 短 ， 其 关 和 运动 近似 为 余 嘴 曲线 ， 当 期望 速 度 超 过 设 定 冰 值 时 ， 根 关节 的 运动 局 
期 保持 不 变 ， 而 周期 内 转动 角 民 逐渐 增 大 ; 当期 慢 速 度 为 钊 数 并 低 于 速度 浆 值 时 ， 根 关 下 运 
动 切 换 为 周期 运动 ， 同 时 文 撑 相 和 摆动 相 严 格 遵循 机 器 人 的 步 态 表 达 式 。 整 个 运动 过 程 连 续 ， 
运动 状态 的 切换 平滑 , 可 以 让 机 器 人 像 昆 虫 一 样 目 然 、 协 调 地 变速 运动 , 证 明了 所 设计 的 CPG 
模型 适合 仿生 六 足 机 器 人 的 变速 控制 。 

该 模型 结构 简单 ， 信 息 容 量 大 ， 包 含 了 时 间 域 和 衬 间 域 的 信息 ， 并 且 可 以 方便 地 修改 振 
沪 亏 和 输出， 从 而 进一步 扩展 其 应 用 范围 。 

确切 来 说 ， 在 允许 机 器 人 足 端 轨迹 存在 一 定 误 差 的 情况 下 ， 使 用 该 模型 的 振荡 器 输出 信 
号 控制 机 器 人 根 关 和 运动 可 以 达到 很 好 的 效 素 ， 但 是 在 要 求 关 蔬 运 动 精度 很 局 ， 则 只 能 部 分 
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地 使 用 该 重型。 为 此 ， 在 仿生 六 足 机 融 人 上 应 用 CPG 模型 时 采取 了 如 下 机 制 : 

1) 借助 现 有 便 件 平 合 ， 通 过 软件 方式 实现 神经 元 振 沪 。 在 6 个 根 关 节 电 动机 控制 闫 中 藤 
入 CPG 振荡 器 代码 ， 各 个 神经 元 通过 CAN 总 线 相连 以 实现 耘 合 ， 下 位 机 通过 CAN 总 线 传输 
全 局 的 外 部 激励 。 

2) 单 足 的 神经 元 振 沪 得 出 信号 的 斜率 由 正 变 负 时 《表征 足 切换 为 文 撑 相 )， 电 动机 控制 
人 稻 问 下 位 机 提交 相位 状态 ， 下 位 机 将 该 足 纳 入 实时 规划 队列 ， 并 规划 该 足 各 关节 处 于 文 撑 相 
的 运动 轨迹 。 

3) 单 足 的 神经 元 振 沪 输出 信号 的 斜率 由 负 变 正 时 《表征 足 切换 为 摆动 相 )， 电 动机 控制 
句 问 下 位 机 提交 相位 和 幅 值 信息 ， 并 提出 摆动 相 轨迹 规划 申请 ， 下 位 机 按照 足 冰 轨迹 规划 方 
法 先 规 划 出 理想 的 足 站 运动 轨迹 ， 解 算出 人 艇 关节 和 膝 关 节 的 轨迹 曲线 ， 然 后 将 其 下 传 到 相应 
的 电动 机 控制 硕 。 

基于 上 述 机 制 的 仿生 六 足 机 器 人 并 未 因为 变速 运动 的 要 求 而 影响 其 实时 在 线 运动 的 性 
能 ， 反 而 因 糊 谷 了 运 复 、 降 低 了 运动 精度 和 控制 难度 ， 提 高 了 机 右 人 的 实时 在 线性 能 。 已 外 ， 
采用 软件 方式 实现 神经 元 振 沪 可 以 很 方便 地 调整 参数 ， 避 免 了 便 件 电路 实现 方式 的 缺点 。 


5.3.5 ”机 器 人 传 感 探测 技术 


1. 基于 伪 随 机 序列 自 相 关 性 的 新 型 超声 疲 测 距 系 统 

超声 流传 感 上 副 具有 成 本 低廉 、 结 构 和 位 单 、 体 积 小 等 特点 ， 可 应 用 于 汽车 防 撞 、 机 右 人 路 
径 规划 、 工 业 距 离 测定 、 水 位 液 位 量 测 和 混凝土 结构 探伤 等 领域 。 超 声波 测 距 利用 的 是 超声 
波 近似 直线 传播 和 反射 的 竺 性， 目前 利用 的 是 单 脉 神 激励 式 。 虽 然 这 种 方法 应 用 比较 广汉 ， 
但 其 存在 如 下 缺陷 : 忆 在 实际 训 距 过 程 中 ， 环 境 中 温度 、 湿 度 、 气 压 对 超声 流 的 传播 速度 都 
会 产生 影响 ，@ 温 度 变 化 的 影响 最 大 ， 用 340my/s 代替 超声 波 传播 的 速度 必 将 引入 测量 误差 ; 
G) 超 声波 回流 信号 是 一 个 调制 信号 ， 无 明确 的 回流 信号 前 治 ， 因 而 在 确定 小 越 时 间 的 过 程 中 ， 
其 基准 点 的 选择 已 成 为 测量 误 关 的 主要 来 源 ; 外 噪声 与 回 波 同时 被 接收 ， 即 使 电路 中 融 有 滤 
六 电路， 与 脉冲 频 京 相近 的 噪声 依旧 无 法 小 除 ， 这 将 造成 误 触 友 。 上 述 问 题 已 成 为 制约 利用 
超声 波 测 距 的 答 颂 。 

伪 随 机 序列 是 一 个 具有 一 定 周期 的 取 值 为 0 和 1 的 离散 码 序 列 ， 它 具有 与 随机 噪声 相似 的 
尖锐 目 相 关 函 数 特 性 ， 但 它 并 非 丰 正 随机 ， 而 是 按 一 定 的 规律 周期 性 变化 的 序列 。m 序列 是 伪 
随机 序列 的 一 种 ， 是 由 移 位 寄存 器 反馈 连接 产生 的 最 大 线性 长 度 的 序列 ， 其 特征 多 项 式 为 




























































































fAX)=c0 toxte x 十 Pe x GY (5-55) 





两 个 长 为 的 实 离散 时 间 序 列 x(n) 与 y(n) 的 互相 关 函 数 可 由 式 (5-55) 计算 得 出 ， 
即 


N-l 
ry( 7)= ,XMDY n+D) (5-56) 


n=0 
式 中 ，7 为 延迟 时 间 。 
由 式 (5-56) 可 得 六 序列 的 目 相 关 图 数 2 为 分 段 国 数 : 当 T=0 时 , 7.(7D=1; 当 z7 关 0 
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时 ，z,(D=1/P,，P 为 m 序 列 的 周期 。 

当 伪 随机 序列 的 周期 足够 大 时 ， 其 自 相 关 函 数 具 有 尖锐 的 二 电 平 特性 ， 接 近 于 6 也 
数 。 基 于 伪 随 机 序列 上 自 相 关 性 的 狐 型 超声 波 测 距 系 统 中 ， 正 是 利用 伪 随 机 序列 尖锐 的 自 
相关 函数 特性 ， 来 测量 发 射 码 和 接收 码 之 则 的 延 时 ， 从 而 计算 出 渡 越 时 间 。 在 测量 的 过 
程 中 ， 绝 大 多 数 噪声 与 伪 随 机 序列 都 不 相关 ， 这 些 噪 声 都 可 以 通过 计算 收发 序列 的 相关 
国 数 来 抑制 。 

(1) 新 型 超声 波 测 距 系 统 的 测 距 原理 ”新 型 超声 波 测 距 系 统 由 三 个 模块 组 成 : 渡 越 时 
间 确 定 模 块 、 超 声波 传播 速度 实时 测量 模块 和 信息 融合 模块 。 基 于 伪 随 机 序列 良好 的 自 相 
关 特 性 ， 超 声波 测 距 系统 可 准确 地 测量 出 超声 小 的 传播 速度 和 渡 越 时 间 ， 进 而 计算 出 障碍 
物 的 距离 。 

1) 渡 越 时 间 的 确定 。 基 于 m 序列 民 好 的 自 相 关 性 来 测定 渡 越 时 间 ， 渡 越 时 间 测 定 的 过 程 
如 下 : 由 TMS320VC5509A DSP 产生 的 六 序列 通过 通用 IO 引 脚 输出 ， 激 励 超声 波 发 射电 路 
将 其 转换 成 对 应 的 超声 波 信 号 发 射出 去 ， 超 声波 过 到 目标 会 反射 回来 ， 超 声波 接收 模块 将 其 
滤波 、 放 大 后 ， 通 过 序列 还 原 模 块 还 原 成 对 应 的 离散 序列 ， 与 本 地 但 发 生 模块 产生 的 m 序列 
进行 相关 运算 。 记 录 下 相关 国 数值 取 值 最 大 时 ， 本 地 产 序 列 与 接收 到 信号 的 还 原 后 m 序列 的 
相位 甜 N， 渡 越 时 间 可 由 式 (5-57) 计算 得 出 ， 即 

T=NW (5-57) 


2) 超声 波 传播 速度 的 实时 测量 。 渡 越 时 间 实 时 测量 模块 是 由 一 对 超声 波 换 能 器 和 长 方 体 
目标 组 成 。 一 对 超声 波 换 能 占用 于 收发 超声 波 ， 长 方 体 目 标 距 超 声波 换 能 上 费 的 距离 已 知 ， 设 
为 qd。 超声 波 换 能 器 在 发 射电 路 的 激励 下 产生 超声 波 ， 发 出 的 超声 波 遇 到 长 方 体 目标 后 反射 回 
超声 波 换 能 器 ， 该 过 程 渡 越 时 间 To 的 测定 原理 如 上 文 所 述 。 则 超声 波 实时 的 传播 速度 可 由 式 
(5-58) 计算 
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(5-58) 














3) 信息 融合 模块 。 信 息 融 合 模块 主要 由 TMS320VC5509A DSP 组 成 ，TMS320VC5509A 
是 TI 公司 生产 的 一 种 高 性 能 、 低 功 耗 的 定点 DSP。 其 主要 负责 m 序列 的 生成 、 相 关 运 算 及 障 
但 物 距离 的 计算 。 障 但 物 的 距离 S$ 可 由 式 《5-59) 计算 
LT-lL2d7 dr 
2 2 Lo Lo No 
(2) 新 型 超声 波 测 距 系 统 的 硬件 电路 ”新 型 超声 波 测 距 系 统 的 人 硬件 电路 主要 包括 三 部 
分 : 发 射电 路 、 接 收 电 路 和 数据 采集 电路 。 硬 件 电路 原理 如 图 5-34 所 示 ， 其 中 由 
TMS320VC5509A DSP 把 存储 在 其 内 部 的 伪 随 机 码 作 为 使 能 信号 加 到 NE555 定时 器 上 , 控 
制 NES55 发 射出 带 有 伪 随 机 三 进 制 序 列 的 信和 号 来 驱动 超声 波 换 能 占 。 当 由 NE555 发 出 高 
电 平 信号 时 ， 超 声波 换 能 器 发 出 信号 ; 当 NE555 发 出 低 电 平 信 号 时 ， 超 声波 换 能 器 就 不 发 
出 信号 ， 从 而 实现 用 伪 随 机 序列 信号 调制 超声 波 信 号 。 回 波 到 达 超 声波 换 能 器 后 经 过 前 端 
放大 、 带 通 滤 波 、 后 级 放大 、 整 流 电 路 、 采 集 电 足 后 ， 以 脉冲 的 形式 回 到 TMS320VC5509A 
DSP 中 。 








($=59:) 
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采集 | | 整流 | _ | 后 级 
电路 | ”| 电路 三 | 放大 
采集 电路 
- - 接收 电路 


图 5-34 ” 狐 型 超声 波 测 距 系 统 价 件 电路 原理 

图 5-35 所 示 为 狐 型 超声 波 测 距 系 统 的 发 射电 路 ， 激 励 信 号 源 由 一 个 NE555 定时 器 发 出 ， 
伪 随 机 码 作为 调制 信号 由 DSP 发 出 , 接 到 NE555 的 使 能 管 脚 上 ， 由 NE555 定时 器 发 出 40kHz 
的 方 波 信号 。NE555 发 出 的 激励 信号 经 过 一 个 NPN/PNP 型 晶体 管 的 互补 功率 放大 电路 ， 直 接 
加 到 一 个 由 MOSFET 构成 的 放大 电路 上 。MOSFET 实质 上 是 高 速 开 关 器 件 ， 受 到 输入 输出 间 
的 耦合 、 配 线 等 寄生 电感 的 影响 而 不 稳定 , 因此 必须 插入 一 个 门 极 电阻 R4。 为 了 保证 MOSFET 
能 够 很 好 地 实现 开关 动作 ， 在 其 前 级 采用 了 NPN/PNP 型 晶体 管 互 补 功率 驱动 电路 。 在 与 DSP 
的 接口 处 用 光 耘 进行 隔离 ， 光 不 在 这 里 起 到 保护 和 匹配 电压 的 作用 。 



































图 5-35 ”新 型 超声 波 测 距 系 统 的 发 射电 路 
接收 电路 分 为 四 个 部 分 ， 分别 是 前 级 放大 电路 、 和 珊 通 小 波 电 路 、 后 级 放大 电路 、 局 速 化 


的 绝对 值 电路 。 

前 级 放大 电路 的 原理 如 图 5-36 所 示 。 由 于 超声 流传 感 希 输出 的 信号 十 分 微弱 ， 属 于 mV 
级 ， 因 此 必须 先进 行 前 级 放大 。 采 用 仪表 放大 器 AD620 对 采集 到 的 信号 进行 放大 ， 放 大 倍数 
为 100 倍 。 

囊 通 滤波 电路 部 分 为 一 个 压 控 电压 源 的 二 阶 带 通 滤波 器 ， 如 网 5-37 所 示 。 因 为 超声 波 信 
号 的 中 心 频 率 为 40kHz， 所 以 带 通 滤波 器 的 中 心 频率 力也 选 为 40kHz。 将 相关 的 数据 代入 ， 经 
计算 可 得 带 通 滤波 器 的 带宽 为 2.069kHz， 品 质 因数 O=19.3， 具 有 良好 的 选择 性 。 
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图 5-37” 禹 通 滤波 电路 
后 级 放大 部 分 是 对 滤波 后 的 信号 进一步 放大 ， 上 有 目的 是 把 信号 放大 到 可 以 被 后 续 电 路 进行 














处 理 的 程度 ， 采 用 集成 运算 放大 器 对 滤波 后 的 信号 放大 10 倍 。 

通过 后 级 放大 器 所 接收 到 的 超声 波 回 波 信号 是 禹 有 伪 随 机 序列 的 信 写 ， 采 用 高 速 化 绝对 
值 转换 电路 将 伪 随 机 序列 从 超声 波形 中 解 调 出 来 。 通 过 高 速 化 绝对 值 电路 能 够 把 回声 信和 号 处 
在 负 半 轴 的 部 分 转 到 正 半 轴 ， 以 提高 信号 的 有 效 值 ， 从 而 得 出 所 需要 的 伪 随 机 序列 。 高 速 化 
绝对 值 转换 电路 如 图 5-38 所 示 ， 当 输入 信和 号 为 负 时 ，VD1 截止 ，VD2 导 通 ，U1 为 倒 相 放大 
器 ，Uz2 为 正 向 放大 器 ; 当 输 入 信号 为 正 时 ，VD1 导 通 ，VD2 截止 ，U1 为 倒 相 放大 器 ，U2 也 
为 倒 相 放大 器 。 因 此 无 论 输入 信号 的 电压 极 性 如 何 ， 其 输出 总 是 正 电压 ， 旦 幅 值 不 变 。 如 前 
所 述 ， 超 声波 回 波 信 号 经 过 绝对 值 变 换 电 路 以 后 ， 负 电压 补 翻转 为 正 电 压 ， 且 频率 倍增 ， 然 
后 通过 二 极 管 VD3、 电 容 C10 组 成 的 检 波 电路 对 新 波形 进行 包 络 。 

回 波 信号 携 融 看 伪 随 机 序列 的 信息 ， 而 数据 采集 的 目的 就 是 要 从 超声 波 的 信号 中 把 伪 随 
机 序列 提取 出 来 。 伪 随机 序列 属于 低频 信号 ， 所 以 采用 采样 频率 为 100kHz 的 MAX164 作为 
模 数 转换 芯片 , 图 5-39 为 MAX164 与 DSP5509A 的 硬件 连接 图 。 如 图 5-39 所 示 , 把 MAX164 
的 CS 与 DSP 芯片 的 CE3 管 脚 相连 ， 从 而 把 MAX164 的 地 址 映射 到 CE3 空间 ; 将 McBSP1 
的 FSR 引 脚 〈S12) 配置 成 GPIO 与 MAX164 的 BUSY 相连 ， 用 于 读 取 ADC 的 状态 位 ; 用 
DSP 的 地 址 线 A0 与 MAX164 的 RD 相连 ， 用 于 控制 启动 模 数 转换 。 采 用 Slow Memory 模式 ， 
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并 行 读 入 数据 ; 时 钟 采用 外 部 时 钟 模 式 ， 在 MAX164 外 加 一 个 晶振 ， 其 输出 端 与 MAX164 的 
CLKOUT、CLKIN 分 别 相 连 。 





C13 


号 C14 
TXTAL 





图 5-39 MAX164 与 DSP5509A 的 硬件 连接 图 

(3) 新 型 超声 波 测 距 系统 的 软件 设计 “新 型 超声 流 测 距 系统 的 软件 部 分 主要 实现 以 下 几 
个 功能 : 一 是 控制 超声 波 换 能 器 发 出 携 市 伪 随 机 序列 的 超声 波 信 号 ; 二 是 采集 回流 信号 ; 三 
是 进行 相关 性 判别 并 计算 出 渡 越 时 间 ; 四 是 计算 障碍 物 的 距离 。 

整个 软件 系统 包括 两 层 循环 : 外 层 循环 是 用 来 输出 各 个 传感器 的 距离 值 ， 内 层 循环 是 用 
来 判别 采集 到 的 数据 是 否 满 一 个 周期 ， 当 采集 到 的 数据 达到 一 个 周期 以 后 ， 系 统 便 置 位 标志 
位 ， 关 闭 定时 器 中 断 和 外 中 断 ， 此 时 也 就 集 止 了 数据 的 发 射 与 接收 ， 并 开始 顺序 执行 相关 判 
靳 程序 和 距离 计算 程序 ， 最 后 输出 距离 值 ， 并 且 清 除 标志 位 ， 进 行 下 一 次 同样 的 循环 。 

如 何 准确 、 快 速 地 进行 相关 性 判 列 是 新 型 超声 波 测 距 系统 软件 设计 的 核心 。 采 用 基于 快 
速 傅 里 叶 变 换 (FFT) 的 相关 判 列 算法 来 判断 本 地 码 序 列 和 接收 到 的 序列 是 否 相 关 ， 以 提高 相 
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关 判 别 的 实时 性 ， 具 体 步 又 如 下 : 

1) 将 本 地 码 序列 民办 进行 FFT 求 得 系 ( 。 

2) 将 采集 到 的 回 波 进行 采样 得 到 离散 序列 y(n) ， 将 该 离散 序列 进行 FFT 求 得 YC) 。 

3) 计算 R,(PD= XCOYCP 。 

4) 对 RCA 进行 快速 傅 里 叶 逆 变 换 ， 得 x_(7)， 并 判断 xr,( 如 是 否 有 峰值 脉冲 出 现 ， 若 有 
峰值 脉冲 出 现 ， 则 跳 转 到 步 又 5)， 否 则 跳 转 到 步 又 2)。 

5) 计算 时 延 。 

若 伪 随机 序列 的 长 度 为 N， 直 接 采 用 式 〈$-$6) 进行 相关 性 判别 运算 ， 其 运算 量 为 六 次 
实数 乘法 和 次 实数 加 法 。 采 用 基于 FFT 的 相关 判别 算法 可 使 计算 量 降 至 (3Vlog, N + N) 次 
乘法 和 (3Nlog, V+ V) 次 加 法 。 采 用 TMS320VC5509A DSP 作为 相关 函数 的 运算 单元 ， 其 数 
据 处 理 能 力 强 大 ， 必 上 内 部 具有 便 件 乘法 匿 ， 提 供 专 门 鸭 FFT 指令 ， 使 得 FFT 算法 实现 的 速 
度 很 快 ， 有 效 地 提高 了 实时 性 。 

(4) 新 型 超声 波 测 距 系 统 的 测 距 误 差 补偿 ”由 于 收发 电路 和 信号 处 理 器 在 对 信号 的 处 理 
过 程 中 均 会 对 回 波 信号 产生 一 定 的 有 影响， 产生 一 个 固定 的 时 延 At ， 从 而 产生 一 定 的 测量 误差 。 
对 系统 的 延迟 时 间 的 校正 算法 如 下 : 

设 记 、 瑟 为 两 个 已 知 的 固定 距离 , 超声 波 在 这 两 个 固定 的 距离 中 传播 的 渡 越 时 间 为 ti、b， 
则 超声 波 在 L1、L 距离 内 往返 传播 所 需要 的 时 间 实 际 上 分 为 1 - At 和 1, -At。 



































及 算 Lp ft —A?) ($5-60) 
2 
1 

L,=—V(t, -AD (5-61) 
2 

由 式 (5-60)、 式 (5-61) 可 得 

Li-—Lt 

At 一 -1 1 2 对 

De (S-62 ) 





在 计算 超声 波 传 播 的 渡 越 时 间 的 过 程 中 ， 需 要 将 采集 到 的 一 个 周期 序列 与 本 地 序列 进行 
相关 性 判 列 运算 ， 在 每 次 运算 中 算出 的 结果 都 取 码 元 宽度 的 整数 倍 。 但 在 大 多 数 情 况 下 ， 超 
声波 在 空气 中 渡 越 时 间 都 不 是 码 元 宽度 的 整数 倍 ， 这 样 束 造成 了 测量 结果 偏 大 。 这 个 误差 的 
最 大 值 为 一 个 人 码 元 党 度 的 时 间 所 传输 的 距离 ， 最 小 值 为 0。 为 了 减 小 误差 可 以 在 每 一 个 测量 结 
果 上 减 去 半 个 人 码 元 时 间 所 传输 的 距离 ， 这 样 束 可 以 把 计算 渡 越 时 间 产 生 误差 的 最 大 值 减 小 到 
半 个 人 码 元 时 间 内 超声 波 传 输 的 距离 。 

(5) 性 能 测试 实验 与 分 析 ”其 于 伪 随 机 序列 自 相 关 性 的 狐 型 超声 波 测 距 系 统 的 原理 样机 
如 图 5-40 所 示 。 

在 进行 新 型 超声 波 测 距 系 统 人 硬件 电路 的 测试 时 , 伪 随 机 码 的 周期 为 13， 码 元 宽度 为 1ms， 
该 序列 为 “1，1，1，1，0，0，0，1，0，0，1，1，0，1，0”。 由 DSP 数字 信号 处 理 器 的 GPIO 
口 发 出 的 伪 随 机 序列 ， 经 过 光 耦 隔离 后 ， 在 示波器 上 的 显示 波形 如 网 5-41 所 示 。 经 放大 电路 
后 的 驱动 信号 效果 如 图 5-42 所 示 ， 张 动 波形 为 经 过 伪 随 机 信和 号 调制 的 方 波 信号 ， 并 且 达 到 了 
预期 的 放大 效果 ， 虽 然 经 过 放大 后 的 波形 与 原 波 形 反 问 ， 但 是 作为 驱动 信号 ， 这 不 影响 超声 
波 换 能 器 的 正常 工作 ， 其 能 够 顺利 地 把 伪 随 机 序列 加 载 到 超声 波 信号 上 。 
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图 $-40 ”新 型 超声 波 测 距 系统 的 原理 样机 





图 5-41 DSP 所 发 出 的 伪 随 机 序列 

超声 波 接收 换 能 器 接收 到 的 信号 是 40kHz 的 正弦 波 信号 ， 经 过 放大 、 滤 波 和 高 速 绝 对 值 

化 电路 得 到 的 波形 如 图 5-43 所 示 。 由 图 5-42 可 知 ， 通 过 高 速 绝 对 值 化 电路 之 后 ， 降 低 了 余 

波 的 拖 尾 现象 ， 使 系统 采样 得 到 的 信号 更 加 准确 。 通 过 观察 图 5-42 的 包 络 波形 ， 可 知 图 中 两 

条 红线 之 间 的 部 分 便 是 一 个 周期 的 伪 随 机 序列 ， 其 数值 为 “1，1,，1, 1, 0, 0, 0，1,，0, 0， 

1，1，0，1，0”， 这 个 结果 和 DSP 发 出 的 伪 随 机 序列 完全 吻合 ， 从 而 验证 了 系统 便 件 设计 的 

正确 性 与 可 行 性 。 经 过 AD 转换 后 的 回流 信号 与 本 地 但 序列 作 相 关 运 算 的 结果 如 网 5-44 所 示 ， 
尖峰 脉冲 出 现在 相位 为 12 的 时 候 。 
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图 5-43 ”经 过 高 速 绝对 值 化 电路 得 到 的 波形 
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新 型 超声 波 测 距 系 统 的 原理 样机 的 距离 测量 实验 在 温度 为 20.2'C, 湿度 为 42.5% 的 环境 中 
进行 , 在 此 实验 环境 中 人 为 地 加 入 了 与 超声 波 频率 相近 的 噪声 , 所 加 入 噪声 的 频率 范围 为 37~ 
43kHz。 新 型 超声 波 测 距 系统 测 得 的 超声 波 在 此 环境 下 传播 344.6m/s。 从 实验 结果 可 以 看 出 ， 
在 测量 距离 为 0.4 一 5.0m 新 型 超声 波 测 距 系统 的 范围 内 ， 测 距 误差 在 1.8% 以 内 ， 且 具有 良好 
的 抗 干扰 性 。 











图 5-44 ”相关 运算 结果 


2. 适用 于 特种 机 器 人 导航 系统 的 自 适应 卡尔 曼 滤 波 算法 

导航 技术 是 特种 机 器 人 的 关键 技术 之 一 ， 也 是 特种 机 器 人 实现 智能 化 的 基础 。 准 确 确定 
自身 的 位 置 是 特种 机 器 人 适应 环境 、 进 行 目 主 作 业 的 前 提 。 精 度 高 、 抗 干扰 能 力 强 、 实 时 性 
好 是 对 特种 机 器 人 导航 系统 的 基本 要 求 。 

为 提高 导航 的 精度 和 抗 干 扰 能 力 ， 机 右 人 第 和 将 多 种 导航 器 件 有 机 组 合 、 互 补 使 用 ， 并 
采用 卡尔 曼 滤 小 算法 对 组 合 导 航 系 统 的 参数 进行 校正 。 仿 生 六 足 机 器 人 采用 GPSVINS 组 合 导 
航 系统 。GPS 全 球 定位 系统 以 空间 卫星 为 基础 来 实现 导航 与 定位 ， 具 有 人 全天候、 全球 履 盖 、 
全 方位 、 高 精度 等 特点 ， 且 没有 时 间 积 累 误 差 ， 但 采用 GPS 技术 进行 单独 导航 时 ， 在 有 遮挡 
物 的 环境 中 容易 产生 “天星 ”现象 。INS 系统 能 不 依赖 外 界 信息 ， 完 全 独立 自主 地 提供 多 种 导 
航 参数 ， 但 是 导航 参数 的 误差 会 随时 间 积 累 ， 不 适用 于 长 时 间 单 独 导 航 。 将 GPS 需 件 和 INS 
器 件 进 行 有 机 地 组 合 ， 可 以 各 取 所 长 。 当 GPS 信和 号 受到 高 强度 干扰 或 当 卫 星系 统 接收 机 出 现 
故障 时 ，INS 系统 可 以 独立 地 进行 导航 定位 。 高 精度 的 GPS 信息 可 以 用 来 修正 INS， 控 制 其 
误差 随时 间 的 积累 。 

基于 GPS/TNS 的 组 合 导航 系统 可 用 如 下 一 阶 线性 状态 方程 (5-63) 和 量 测 方程 (5-64) 
表示 ， 即 










































































XD= FOOXOD+IGDWOD (5-63) 
Z(t)= H(DX(1+VOD) (S-04 ) 
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第 5 章 ”新 型 仿生 六 足 机 器 人 


陈 中 ，X(D 为 系统 状态 天 量 ; (DD 为 系统 的 状态 窃 阵 :CCD 为 系统 的 动态 噪声 矩阵 ; 
W(D 为 系统 的 过 程 日 噪声 和 天 量 ; ZY(D 为 系统 的 量 测 天 量 ;， HOD 为 量 测 矩阵 ， 瑟 为 系统 的 
量 测 噪声 天 量 。 取 状态 天 量 为 


X=[6L 4 6h Ove Ovy Ov Gp Oy Py Es Ey, Es Ve V VT 


r 








其 中 ，0L 、A0UM 、6h 表示 经 度 、 纬 度 、 局 度 的 误 蕾 ， ov 、Ovy 、0W 表示 东 、 北 、 大 
罕 方 向 的 移动 速度 误 天 ;Vs 、9Wy 、9 表示 东 、 北 、 天 空 方 同 的 航 疝 姿态 角 误差， 6,, 、 6%y、 
2- 表示 随机 漂移 ;V,、V,、V, 表示 加 速度 计 零 偏 。 

选择 GPS/INS 的 位 置 、 速 度 观测 信息 来 组 成 量 测 方程 。INS 的 位 力量 测 信息 可 表示 为 地 
理 坐 标 系 下 的 丰 实 值 与 相应 误差 之 和 。 











1 |=| N+ ($5-65) 














GPS 接收 机 输出 的 位 置 量 测 信息 ， 可 表示 为 地 理 系 下 的 真实 值 与 相应 的 误 送 之 兰 。 


N 
六 
R 


M 





1, |=| -一 一 一 (5-66) 


h —N;, 


式 中 ， 工 、 录 、 有 分 列 为 机 右 人 在 大 地 坐标 系 中 的 实际 位 置 ，Ny 、Ns、N; 为 GPS 接 
收 机 党 东 、 北 、 天 空 方 同 的 位 置 误 和 天; Ry 为 地 球 参 考 椭 圆 球 子午 阐 上 各 点 的 曲率 半 笃 ， 
Ry = RA1-2f+3f sin 1); Ry 为 地 球 参考 椭 球 卯 西 圈 上 各 点 的 曲率 半径 ,R=R(1+f sin’ DD); 
R, 为 地 球 椭圆 长 半 轴 ;，J 为 地 球 椭圆 局 这 。 

位 置 量 测 天 量 定 义 如 下 











(LL) R, ROL+N, 
Z(t)=| (NW -hc) RycosL |=| RyONdcosL+ Ne 
hh = hh Oh+N,, 
= HDX(D+V DD) 
INS 的 速 有 度量 测 信息 可 表示 为 地 理 坐 标 系 下 的 真实 值 与 相应 的 速度 误 碟 之 和 。 
We yy + OV, 


Vp |=| Ve + OvVg (S$—68) 


Vy Vj + OV, 


式 中 ，vs 、vVy、vVu 是 机 占 人 在 地 理 坐 标 系 下 东 、 北 、 天 空 方 同 上 的 真实 速度 。 
GPS 的 速度 量 测 信息 可 以 表示 为 地 理 坐 标 系 下 的 真实 值 与 相应 的 速度 误 兰 之 产 。 


© 


(S$-67) 





























大 学 生 课 外 科技 创新 竞赛 获奖 作品 精 析 


Voy vy -My 
Vop = VE —M. (S-09 ) 
Vovu vy —M, 





式 中 ，M;、M、、、 Mi 为 GPS 接收 机 的 速度 测量 误差 在 东 、 北 、 天 衬 举 标 轴 上 的 分 量 。 
速度 量 测 矢 量 定 义 如 下 























Ds Ovy + My 
ZID=| vp -vor |=| Ov + Me. ed 
Wi = We Ov + Mi 
=H DX(D+V (DD 
由 位 置 测 量 和 失 量 式 《5-67〉 和 速度 测量 矢量 式 (5-70) 可 得 基于 GPS/INS 导航 系统 的 位 
置 、 速 度量 测 方程 
po ZL HD x VC) 
D) = = f) ++ 
ZH) \H.D VCD (5571 
= H(t1)X(t)+V() 
位 置 量 测 矢量 的 噪声 标准 产 为 
oy | {0o,HDOP, 
mi =| op |=| 0,HDOP; (S572.) 


OFDOP 


Oy 
速度 量 测 天 量 的 噪声 标准 差 为 
ov,) (caDoOP， 
0, =| ovp |=| 0, HDOP: 《5S-73 ) 
ov ) LosrDOP 








式 中 ,0w 为 GPS 接收 机 的 伪 距 测量 误差 的 标准 差 ， “2 为 GPS 接收 机 的 伪 距 测量 率 误差 的 标 。 
准 关 EDOP, 为 GPS 接收 机 输出 的 北方 向 上 的 水 平 位 置 精度 因子 ，EDOP 为 GPS 接收 机 输 
出 的 方向 东 上 的 水 平 位 置 精度 因子 ，VDOP 为 GPS 接收 机 输出 的 垂直 位 置 精 度 因 子 。 

由 式 (5-72)、 式 《5-73) 可 知 ， 导 航 系统 的 量 测 噪声 主要 由 GPS 接收 机 的 伪 距 测量 误差 、 
伪 距 率 测 量 误差、GPS 接收 机 输出 的 水 平 位 置 精度 因子 和 垂直 位 置 精 上 度 因 子 决 定 。GPS 接收 
机 的 伪 距 测量 误 兰 、 伪 距 率 测量 误差 与 GPS 接收 机 的 软件 解 算 算法 及 其 硬件 性 能 水 平 相关 ， 
因此 对 于 确定 类 型 的 GPS 接收 机 可 认为 其 伪 距 量 测 误差 和 伪 距 率 量 测 误 差 是 一 个 定 值 ， 而 水 
平 精 度 因 子 和 垂直 精度 因子 是 时 变 的 ， 其 随 捕 捉 到 卫星 的 数目 和 位 置 情况 而 变化 。 因 此 ，GPS 
接收 机 输出 的 水 平 位 置 精度 因子 和 王 直 位 置 精度 因子 是 影响 基于 GPSVINS 导航 系统 数学 模型 
中 量 测 噪声 改变 的 重要 因素 。 

为 提高 导航 系统 的 抗 干扰 能 力 ， 获 得 更 加 精准 的 导航 参数 ， 对 导航 器 件 输 出 的 信息 进行 
滤波 是 必要 的 。 采 用 卡尔 曼 滤波 时 ， 如 果 滤 波 模 型 与 实际 系统 不 从 ， 不 能 真实 地 反映 物理 过 
程 ， 使 模型 与 获得 的 量 测 值 不 匹配 ， 就 会 产生 滤波 误差 ， 甚 至 可 能 发 生 滤波 发 散 现象 。 因 此 ， 
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有 必要 对 卡尔 曼 滤 波 进行 实时 的 在 线 调 整 ， 防 止 滤波 发 散 。 
为 反映 滤波 模型 和 观测 数值 的 匹配 程度 ， 定 义 残 差 
U, =Z, — HX (5-74) 
式 中 ，Z 为 离 敌 化 后 在 k 时 刻 的 量 测 矢 量 ;，HHi 为 离 毅 化 后 在 时 刻 的 量 测 窍 阵 ，X, 为 离散 
化 后 在 大 时 刻 状 态 矢 量 ，X 为 站; 的 一 步 估计 。 残 差 序 列 方差 的 理论 值 D; 和 实测 值 及 可 分 
别 由 式 (5-75)、 式 《5-76) 确定 








必 = H.\ 2 We -1 下 H: + Ri C3513) 
1 i 
F=— > VD (5-76) 
J=i—-N+l 








在 理想 状态 下 ， 和 残 运 序 列 {C } 的 均值 为 零 ， 其 方 大 的 实测 值 与 经 过 卡尔 曼 滤 波 得 到 的 
方 到 的 理论 值 D, 应 该 是 相等 的 ， 即 它们 的 比值 为 1 或 接近 1。 如 来 该 比值 长 期 偏离 1， 则 说 明 
量 测 噪声 已 经 发 生 了 区 化， 需要 对 量 测 噪声 协 方 天 和 窍 阵 Ri 进行 调整 。 

由 前 面 的 分 析 可 知 ，GPS 接收 机 输出 的 垂直 位 置 精 度 因 了 于 POP 与 水 平 位 置 精度 因子 
HDOP 影响 量 测 噪声 的 变化 。 位 蜀 精 度 因 子 PDOP 与 垂直 位 置 精 度 因 子 JPPOP 和 水 平 位 置 精 
度 因子 HDOP 的 关系 为 




















PDOP=N (HDOPY + (VDOP)Y (5-77) 
因此 ， 位 置 精度 因子 PDOP 也 是 调整 量 测 噪声 协 方差 矩阵 的 重要 依据 。 
基于 上 述 分 析 , 提出 一 种 级 联 二 阶 模糊 上 自 适 应 卡尔 曼 滤 波 算法 对 基于 GPS/INS 的 机 器 人 组 合 
导航 系统 进行 滤波 。 如 图 5-45 所 示 ， 将 GPS 和 INS 输出 的 位 置 和 速度 信息 的 差 值 作为 滤波 器 的 
输入 ， 并 实时 监测 滤波 情况 。 当 滤波 至 时 刻 大 时， 如 果 发 现 滤 波 异 常 ， 则 滤波 模型 已 不 宜 用 于 当 
本 的 实际 系统 。 此 时 ， 应 对 时刻 的 量 测 品 声 和 矩阵 进行 调整 ， 以 适应 当前 的 系统 。 调 辛 因子 由 两 
部 分 构成 , 分 别 根据 残 差 序列 的 统计 信息 和 GPS 接收 器 输出 的 位 置 精度 因子 PDOP 来 确定 。 构造 
级 联 二 阶 模糊 逻辑 控制 器 ， 第 一 阶 模 糊 逻 辑 控制 器 的 输入 量 是 残 关 序列 方 兰 的 实测 值 与 理论 值 的 
比值 ， 输 出 一 个 初步 的 调 世 因子 和 第 二 阶 模糊 逻辑 控制 融 输 入 量 是 w 的 值 及 GPS 接收 需 输 出 
的 位 置 精度 因子 PDOP ， 和 输出 为 置信 和 度 调节 因子 w ， 最 终 的 调 方 因子 为 SY (5S, >0，Q 宇 0)。 
X 















































图 5-45 ”级 联 二 阶 模糊 目 适 应 卡尔 曼 滤 波 器 的 原理 图 
根据 上 述 原 理 , 级 联 二 阶 模糊 目 适 应 卡尔 曼 滤 波 器 的 滤波 过 程 可 由 式 (5-78) 一 式 (5-83) 
递 推 实现 。 








A 八 


Xi = Dip Xi (S$S—78) 
X, = Xi t KZ — Hi, Xu) (5-79) 
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天 (5-80) 
Pn = BraP Disa tT aQe Te (CS-81 ) 
P=(T- KH)P,1 ( 5-82) 

R, = Sx Ri (5-83) 








式 中 ，K; 为 增益 算 阵 ，PB 为 估计 误差 的 协 方差 矩阵 ， 荆 i 为 离散 后 的 系统 噪声 矩阵 ;7 为 单 
位 和 矩阵。 

模糊 化 、 模 糊 推理 和 去 模糊 化 是 模糊 逻辑 控制 器 设计 的 核心 步骤 。 用 于 确定 初步 调节 因 
子 S, 的 第 一 阶 模糊 逻辑 控制 硕 输 入 为 残 差 序列 方 兰 的 实测 值 与 理论 值 的 比值 ， 和 输出 为 初步 调 
节 的 精度 因子 5S, 。 输 入 、 输 出 的 隶属 度 函 数 如 图 5-46 和 图 5-47 所 示 。 采 用 近似 于 梯形 的 渐 
变 隶 属 度 函 数 ， 是 为 了 避免 输入 在 近似 理想 的 情况 下 ，FLS 仍然 调节 滤波 因子 而 出 现 滤波 误 
才 的 问题 。 

当 残 差 序列 方差 的 实测 值 严 逐渐 大 于 其 理论 值 疡 时 ， 即 两 者 的 比值 大 于 1， 这 时 ， 应 当 
增 大 应 以 保持 滤波 模型 与 实际 相符 ， 通 过 增 大 Ri 可 以 达到 该 目的 ， 因 此 应 当 给 5 赋 一 个 较 
大 的 值 ， 反 之 则 应 给 5 赋予 较 小 的 数值 。 因 此 ， 第 一 阶 模糊 逻辑 控制 器 的 推理 规则 如 下 : 


rr 
有 如 果 亡 小 于 0.9， 则 S, 小 于 1。 
k 
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2) 如 果 二 -大 于 0.9 且 小 于 1.1， 则 等 于 1。 
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图 5-46 第 一 阶 模 糊 控 制 占 输入 的 隶属 度 函 数 图 5-47 第 一 阶 模糊 控制 右 输 出 的 隶属 度 函 数 


用 于 确定 调整 因子 a 的 第 二 阶 模糊 逻辑 控制 右 的 输入 为 GPS 接收 器 输出 的 位 置 精 度 因子 
PDOP 和 第 一 阶 模糊 逻辑 控制 器 的 输出 S$, ， 输 出 为 调整 因子 a 。PDOP 仪 取 决 于 卫星 在 空间 
的 几何 分 布 。PDOP 较 大 ，GPS 定位 误 芝 较 大 ， 此 时 ， 应 取 较 小 的 a ， 以 减 小 对 测量 值 的 置 
信 度 ; 反之 ， 则 取 较 大 的 a 。 输 入、 输出 的 隶属 度 函 数 如 网 5-48 一 图 5-50 所 示 。 

第 二 阶 模糊 逻辑 控制 器 的 推理 规则 如 下 : 

1) 如 果 S 大 于 1， 有 月 PDOP 为 好 ， 则 Q 大 于 1。 

2) 如 果 S, 大 于 1， 征 PDOP 为 中 ， 则 w 等 于 1。 

3) 如 果 9 大 于 1， 且 PDOP 为 差 ， 则 w 小 于 1。 

4) 如 果 9 小 于 1， 且 PDOP 为 好 ， 则 Q 大 于 1。 

5) 如 果 S 小 于 1， 且 PDOP 为 中 ， 则 w 等 于 1。 

6) 如 果 S, 小 于 1， 有 日 PDOP 为 差 ， 则 w 小 于 1。 
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图 5-48 第 二 阶 模糊 控制 器 PDOP 的 隶属 度 函 数 图 5-49 ”第 二 阶 模糊 控制 右 sy 的 隶属 度 函 数 
~ Se 2 2 
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图 5-50 第 二 阶 模糊 控制 器 输出 的 隶属 度 函 数 
图 5-51 是 采用 常规 卡尔 曼 小 小 与 级 联 二 阶 模糊 目 适 应 卡尔 曼 滤 波 算 法 的 滤波 效 坟 对 比 。 
从 仿真 结果 中 可 知 : 当 噪 声 不 发 生变 化 时 《前 50s)， 两 种 滤波 算法 的 定位 误差 均 有 收敛 的 趋 
势 ， 小 波 效 来 曲线 几乎 重合 ,但 当 加 入 时 变 品 声 时 (50 一 1000s )， 采 用 级 联 二 阶 模糊 目 适应 卡 
尔 曼 滤波 算法 的 导航 系统 的 精度 和 稳定 性 优 于 采用 常规 卡尔 曼 的 导航 系统 。 这 是 由 于 当量 测 
噪声 时 变 时 ， 采 用 常规 卡尔 曼 小 的 导航 系统 的 量 测 噪声 模型 并 没有 随 之 改变 ， 造 成 小波 模型 
与 实际 人 不符， 因而 出 现 了 较 大 的 误差 和 不 稳定 性 。 而 所 提出 的 级 联 三 阶 模糊 目 适 应 卡尔 曼 洲 
波 算 法 根据 残 兰 序 列 的 统计 信息 和 GPS 接收 费 输 出 的 位 置 精度 因子 的 变化 情况 ， 通 过 级 联 二 
阶 模糊 逻辑 控制 占 实 时 修正 小 波 如 的 小波 调节 因子 ， 不 断 地 改变 量 测 噪声 的 模型 ， 能 够 反映 
实际 滤波 的 物理 过 程 ， 因 而 其 小 波 性 能 优 于 第 规 卡 尔 曼 小 小 算 法 。 
































0.25 - 一 常规 卡尔 曼 滤 波 
一 级 联 二 阶 模糊 自 适应 卡尔 曼 滤 波 
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图 5-51 各 规 卡 尔 受 滤波 与 级 联 二 阶 模糊 目 适 应 卡尔 曼 滤 波 算 法 的 滤波 效果 对 比 
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S.3.6 ”机 器 人 原理 样机 实验 


1. 机 器 人 位 姿 变化 运动 

在 进行 本 运动 实验 前 对 仿生 六 足 机 顺 人 的 运动 稳定 性 进行 了 测试 ， 对 机 右 人 施加 短 时 外 
部 神 击 ， 机 喜人 关 贡 误差 能 迅速 收 伺 ， 恢 复 期 望 位 姿 。 实 验 表 明 ， 仿 生 六 足 机 器 人 具有 很 好 
的 抗 干扰 能 

仿生 六 足 机 髓 人 在 任意 足 看 地 时 均 为 6 个 目 由 度 ， 理 论 上 可 以 实现 六 目 由 度 运动 。 仿 生 
六 和 足 机 右 人 可 以 在 任意 位 姿 下 改变 位 姿 , 而 且 位 姿 变 化 的 整个 运动 过 程 连续 、 迅 速 。 图 3-52 一 
图 5-54 显示 了 仿生 六 是 机 各 人 在 位 姿 变 化 运动 的 10s 内 各 个 关节 电动 机 的 运动 轨迹 ， 该 过 程 
实现 了 机 费 人 “ 沿 y 轴 移动 SOmm 一 经 7 轴 旋转 10” 一 治 z 轴 移动 50mm 一 绕 z 轴 旋 转 10” 一 
经 z 轴 旋 转 -10” 一 沿 z 轴 移 动 -50mm 一 绕 y 轴 旋 转 -10” 一 沿 y 轴 移 动 -50mm 一 绕 x 轴 旋 转 
-10” 一 绕 x 轴 旋 转 10”” 这 样 一 次 连续 的 过 程 。 图 5-55 显示 了 原理 样机 的 实际 运动 效 琳 。 
可 见 ， 所 设计 的 仿生 六 是 机 各 人 原理 样机 具有 很 好 的 灵活 性 ， 可 根据 需要 实现 特定 位 姿 ， 为 
其 在 非 结构 环境 下 运动 加 定 了 民 好 的 基础 。 

















根 关节 电动 机 的 位 移 /rad 





髋 关节 电动 机 位 移 /rad 











膝 关 节 电 动机 位 移 /rad 





图 5-54 位 姿 变 化 运动 膝 关 节 电 动机 位 移 曲 线 
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图 5-55 仿生 六 足 机 堪 人 位 姿 变 化 过 程 截图 


2. 机 器 人 全 向 移动 

位 姿 变化 运动 可 以 体现 机 器 人 良好 的 灵活 性 ， 而 全 向 移 动 更 能 体现 机 器 人 的 机 动 性 ， 因 
此 在 考察 机 器 人 的 性 能 时 非常 关注 其 全 回 移 动能 力 ， 在 这 一 方面 ， 仿 生 六 足 机 堪 人 怕 理 样机 
体现 出 非常 好 的 机 动 性 ， 不 仅 可 以 实现 全 癌 直 线 移动 、 原 地 转 问 移动， 而 且 能 实现 这 两 种 运 
动 的 综合 形式 一 一 曲线 移动 。 

图 $-56 一 图 5-61 所 示 为 仿生 六 足 机 器 人 在 直线 前 进 移动 时 各 个 关节 电动 机 的 位 移 曲 线 ， 
其 中 ， 前 进 速度 为 144m/h， 步 长 为 200nm。 可 见 ， 各 个 关节 保持 固定 的 耦合 相位 ， 实 现 了 周 
期 不 规则 步 态 。 














根 关 节 电 动机 位 移 /rad 
根 关 节 电 动机 位 移 /nrad 





图 5-56 前进 移动 元 侧根 关节 电动 机 位 移 曲 线 图 5-57 前进 移动 右 侧根 关节 电动 机 位 移 曲 线 


通关 节 电 动机 位 移 mad 





通关 节 电 动机 位 移 /mrad 
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图 5-58” 击 进 移动 左 侧 髋 天 市 电动 机 位 移 曲 线 图 5-59 ”前 进 移动 石 侧 髋 天 市 电动 机 位 移 曲 线 
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图 $-60 “前 进 移动 左 侧 膝 关节 电动 机 位 移 曲 线 图 5-61 ”前进 移 动 右 侧 膝 关节 电动 机 位 移 曲 线 


上 述 运 动 相应 的 躯体 左 侧 关节 速度 曲线 如 图 $-62 一 图 5-64 所 示 。 可 见 ， 关节 速度 曲线 平 
滑 ， 起 伏 范 围 较 小 。 仿 生 六 是 机 器 人 实验 过 程 (实验 过 程 截图 如 图 5-65 所 示 ) 表明 机 器 人 躯 
体 可 保持 勺 速 、 平 稳 地 前 进 ， 没 有 明显 的 振动 或 起 伏 ， 各 足 的 运动 轨迹 平稳 ， 文 撑 相 和 摆动 
相 之 间 的 切换 过 程 连 续 。 由 于 采用 周期 不 规则 步 态 ， 整 个 运动 过 程 表现 得 更 加 协调 、 目 然 ， 
因而 大 大 增强 了 机 器 人 的 运动 稳定 性 。 




















根 关 节 电 动机 速度 / (rad/s ) 





图 5-62 前进 移动 元 侧根 关节 电动 机 速度 曲线 





偶 关节 电动 机 速度 / (rady/s ) 





图 5$-63 前进 移 动 元 侧 通 关节 电动 机 速度 曲线 


膝 关 节 电 动机 速度 / (rad/s) 





图 5-64 ”前进 移 动 元 侧 膝 关 节 电 动机 速度 曲线 
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图 5-65 ”仿生 六 是 机 桌 人 直线 前 进 过 程 
仿生 六 足 机 堪 人 不 仅 可 以 在 任意 姿态 下 实现 任意 方 回 的 平移 ， 而 且 能 以 一 定 范围 内 的 角 
速度 进行 原 地 转向 ,。 图 $-66 一 几 5-67 所 示 为 仿生 六 足 机 器 人 原 地 左 转 时 根 关 节 电 动机 的 位 移 
曲线 ， 转 问 角 速度 为 7”/$。 与 匀速 直线 前 进 对 比 ， 机 器 人 原 地 转 问 时 ， 对 应 根 关 节 的 行程 发 
生 改 变 ， 对 应 的 艇 天 市 和 膝 关 市 位 移 曲 线 也 随 之 产生 较 大 变化 ， 但 是 各 个 关节 仍旧 保持 固定 
的 相位 关系 。 仿 生 六 足 机 右 人 原 地 转 问 实验 过 程 如 图 5-68 所 未 。 
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图 5-66 原 地 左 转 左 侧根 关节 电动 机 位 移 曲 线 图 5-67 原 地 左 转 右 侧 根 关 节 电 动机 位 移 曲 线 





- 图 5-68 仿生 六 足 机 器 人 原 地 转向 实验 过 和 
实验 表明 : 仿生 六 足 机 需 人 能 以 恒定 的 角速度 进行 忌 地 转 问 ， 转 同 过 程 平稳 ， 单 步 转角 











大 。 同 时 ， 机 磊 人 只 备 实时 在 线 运动 能 力 而 能 以 操作 者 期 望 的 角速度 进行 任意 角度 的 转动 ， 
四 和 局 的 灵活 性 。 

论 上 ， 机 器 人 只 要 具备 直线 移动 能 力 和 原 地 转 问 能 力 束 能 移动 到 任意 目标 位 置 ， 但 是 
me ee 的 移动 过 程 会 严重 影响 运动 效率 ， 此 时 ， 合 理 的 曲线 移动 路 径 可 以 很 好 地 
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兼顾 移动 距离 和 移动 速度 。 通 过 位 姿 、 速 度 和 角速度 等 因素 的 协调 或 改变 ， 仿 生 六 足 机 器 人 
可 以 治 任 意 曲线 路 径 移 动 。 网 5-69 所 示 为 仿生 六 足 机 融 人 的 曲线 移动 过 程 。 





图 5-69 ”仿生 六 足 机 堪 人 的 曲线 移动 过 程 


实验 表明 : 仿生 六 是 机 如 人 能 够 很 好 地 跟踪 圆 孤 路 人 径 曲 线 ， 并 且 移 动 过 程 中 角速度 恒定 ， 
颈 体 移动 平稳 ， 各 足 运 动 协调 。 


3. 机 器 人 越 障 运 动 

仿生 六 足 机 器 人 不 仅 具 有 很 好 的 灵活 性 和 平地 机 动 性 ， 而 且 具 有 和 良好 的 越 障 性 能 ， 越 障 
运动 实验 表明 其 能 够 满足 适应 复杂 环境 的 机 动 需 求 。 

图 $-70 一 图 5-72 所 示 为 仿生 六 足 机 器 人 攀 越 130mm 高 台阶 的 过 程 中 躯体 左 侧 关节 电动 
机 位 移 曲 线 ， 由 图 可 见 : 此 过 程 中 的 根 关 节 电 动机 位 移 曲 线 与 平地 直线 前 进 时 的 类 似 ， 只 是 
在 接近 台阶 边沿 时 稍 有 差异 ， 体 现 了 仿生 六 足 机 器 人 在 台阶 边沿 附近 探寻 可 靠 看 地 点 的 动作 ; 
髋 关节 在 上 台阶 前 、 后 位 移 曲 线 相 同 ， 表 明 机 器 人 在 台阶 上 和 台阶 下 具有 相同 的 位 姿 和 离 地 
高 度 。 仿 生 六 足 机 器 人 上 台阶 过 程 如 图 5-73 所 示 。 
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图 5-71 上 台阶 左 侧 通关 市 电动 机 位 移 曲 线 
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图 5-73 ”仿生 六 足 机 堪 人 上 人 台阶 过 程 


图 5-74 一 图 5$-76 所 示 为 仿生 六 足 机 器 人 敬 爬 10” 笠 坡 时 其 孙 体 元 侧 关 节 电 动机 的 位 移 曲 
线 ， 这 个 过 程 中 的 根 关 节 电 动机 位 移 曲线 与 平坦 地 面 上 前 进 移动 过 程 中 的 类 似 ， 髋 关节 和 腑 
关节 电动 机 在 经 过 上 坡 调 整 后 各 目的 位 移 曲 线 与 上 坡 前 的 类 似 , 其 中 前 是 和 后 是 沿 y 轴 出 现 平 
移 ， 表 明 各 足 的 运动 轨迹 与 其 在 平面 上 的 运动 轨迹 基本 相同 ， 而 前 足 与 后 足 在 坡 面 上 的 “ 基 
本 位 姿 ” 则 与 平面 上 的 略 有 不 同 。 仿 生 六 足 机 闫 人 擎 朴 笠 起 的 运动 过 程 如 网 5-77 所 示 。 
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图 5-75 ”上 坡 左 侧 散 关 市 电动 机 位 移 曲 线 
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图 5-76 上 坡 左 侧 膝 关 市 电动 机 位 移 曲 线 





5-77 ”仿生 六 足 机 器 人 攀 扑 和 斜坡 过 程 

除了 一 段 的 上 台阶 和 和 获 息 冬 坡 过 程 ， 还 进行 了 不 同 蜗 上 度 、 不 同类 型 障碍 的 攀 越 实验 ， 图 

5-78 所 示 为 下 坡 、 下 台阶 、 单 侧 越 障 等 运动 过 程 。 实 验 表 明 ， 仿 生 六 足 机 器 人 对 各 种 障碍 都 

有 很 好 的 适应 性 。 当 隐 碍 物 低 于 机 器 人 的 离 地 高 度 时 机 器 人 保持 位 姿 不 改变 ， 仅 调整 足 端 看 

地 点 ， 反 之 机 器 人 会 根据 障 但 物 状 况 调整 位 姿 。 实 验 过 程 显示 仿生 六 足 机 器 人 在 攀 越 障 但 时 

运动 稳定 ， 动 作协 调 ， 过 程 流 畅 ， 证 明了 基于 昆虫 仿生 研究 的 运动 规划 策略 是 科学 合理 的 ， 
并 且 能 够 使 机 器 人 县 备 优秀 的 运动 性 能 。 

















图 5-78 ”仿生 六 足 机 器 人 的 其 他 越 障 过 程 


主要 创新 点 及 取得 的 成 果 


5.4.1 “作品 主要 创新 点 


作品 主要 创新 点 如 下 : 
1) 建立 了 基于 计算 机 显 微 测 量 技术 和 三 维 高 速 摄影 技术 的 昆虫 观测 实验 体系 。 
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2) 将 典型 昆虫 观测 实验 的 结论 和 规律 应 用 到 仿生 六 足 机 器 人 的 研发 和 设计 中 ， 不 但 注重 
外 形 仿生 ， 更 加 强调 功能 仿生 。 

3) 采用 变 截 面 六 边 形 作 为 机 费 人 驱 体 结构 ， 增 大 了 机 费 人 股 节 活动 空间 ， 提 融 了 其 运动 
的 稳定 性 ， 运 动 肢体 采用 关节 式 结构 ， 和 从 合生 物 形 态 学 要 求 。 

4) 机 如 人 运动 控制 系统 的 整体 架构 采用 仿照 昆虫 神经 系统 的 结构 形式 ， 并 将 多 种 智能 控 
制 算法 综合 应 用 a 到 机 各 人 的 控制 当中 。 

5) 提出 了 一 种 级 联 和 三 阶 模糊 目 适 应 卡尔 曼 滤 波 副 的 控制 算法 ， 并 将 该 握 法 用 于 基于 
GPS/TNS 的 机 费 人 组 合 导航 系统 ， 拓 局 了 在 非 结 构 环 境 中 的 导航 定位 精度 。 

6) 仿生 六 足 机 器 人 员 有 体积 小 、 成 本 低 、 隐 散 性 好 、 机 动 性 局 等 优点 ， 能 够 满足 特种 作 
战 和 信息 作战 的 需要 。 


5.4.2 ”作品 取得 的 成 果 


作品 取得 的 成 果 如 下 : 

1) 新 型 仿生 六 足 机 器 人 原理 样机 1 台 。 

2) 出 版 名 为 《现代 仿生 机 器 人 人 设计》 的 学 术 专 车 1 部 。 

3) 获得 国家 发 明 专 利 3 项 。 

Q 仿生 多 关节 型 机 器 人 腿 部 驱动 传动 闭 置 。 

@ 多 足 机 堪 人 足 端 压力 传 感 句 。 

G@) 一 种 适用 于 特种 机 器 人 的 超声 波 测 距 系统 。 

4) 发 表 有 关 仿 生 六 足 机 器 人 的 学 术 论 文 30 篇 ， 其 中 被 EI 收录 12 篇 。 
5) 获得 第 五 届 “ 挑 战 标 ” 首 都 大 学 生 课 外 学 术科 技 作 品 苋 哟 一 等 奖 。 


总 结 与 展望 



























































S.S.1 作品 研发 工作 总 结 


针对 国内 外 仿生 多 足 机 器 人 的 不 足 ， 项 目 组 本 着 自主 创新 和 技术 集成 相 结 合 、 理 论 分 析 
与 工程 实践 相 结合 、 计 算 机 仿真 模拟 与 实际 测试 相 结合 的 设计 原则 ， 以 “样本 观测 一 理论 分 
析 一 方案 设计 一 实验 验证 一 效能 评估 一 反馈 完善 ”为 研究 思路 ， 根 据 仿生 六 足 机 器 人 各 系统 
的 功能 和 特点 进行 了 有 和 针对 性 、 目 的 性 、 实 用 性 的 设计 、 人 研发、 集成 和 调试 ， 重点 研究 了 “上 典 
型 昆虫 观测 实验 ””“ 机 器 人 机 构 设 计 ”“ 机 器 人 运动 学 分 析 ”、“ 知 能 控制 ””“ 传 感 探 测 ” 等 
关键 技术 ， 并 取得 了 如 下 突破 : 

1) 以 “典型 六 足 纲 昆虫 观测 试验 ”为 依据 ， 将 六 足 纲 昆虫 的 结构 特征 、 运 动 特点 、 神 经 
体系 架构 借鉴 运用 到 仿生 六 足 机 器 人 的 设计 当中 ， 使 仿生 六 足 机 堪 人 与 六 足 纲 昆虫 “不 仅 形 
似 、 更 加 神似 ”。 

2) 仿生 六 足 机 器 人 妥善 处 理 了 运动 稳定 性 和 机 动 灵 活性 的 关系 ， 在 负载 28kg 的 情况 下 ， 
最 高 巡航 速度 为 500m/h， 可 攀 仆 坡度 为 15” 的 斜坡， 翻越 130mm 高 的 沟 坎 。 

3) 仿生 六 足 机 堪 人 结构 设计 新 颖 。 采 用 变 截面 仿 六 边 形 躯体 结构 可 使 机 器 人 有 具有 及 贡 活 
动 空 间 大 等 优点 ， 从 而 大 幅度 提高 了 机 器 人 运动 的 稳定 性 ;机 器 人 运动 胶体 采用 关节 式 结 构 ， 
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单 足 模块 整齐 紧凑 ， 不 存在 附 胶 或 其 他 附件 ， 从 而 提高 了 其 在 灌木 从 、 岩 石 堆 等 环境 下 的 运 
动 性 能 。 

4) 针对 仿生 六 足 机 器 人 在 非 结 构 环 境 下 作业 干扰 大 的 特点 ， 设 计 了 基于 伪 随 机 序列 自 相 
关 性 的 超声 波 测 中 系统 ， 大 大 提高 了 测 距 的 精度 和 抗 干扰 能 力 ;， 提出 了 一 种 级 联 二 阶 模糊 目 
适应 卡尔 受 滤 波 噩 的 设计 方法 ， 并 将 该 算法 应 用 于 基于 GPS/TNS 的 机 器 人 组 合 导 航 系 统 中 ， 
提高 了 其 在 非 结 构 环 境 中 导航 定位 精度 ， 从 而 为 仿生 六 足 机 器 人 实现 智能 控制 和 目 主 化 作业 
真 定 了 基础 。 


5.5.2 ”作品 应 用 范围 及 前 景 分 析 


狐 型 仿生 六 惧 机 占 人 上 其 有 外 观 独 视 、 运 动 姑 活 、 隐 税 性 好 、 稳 定性 噩 等 优点 ， 同 时 还 其 
有 民 好 的 越 障 和 如 障 能 力 ， 可 适应 复杂 的 非 结 构 化 地 形 ， 能 够 实现 目 主 定位 和 目标 识别 ， 在 
星球 探测 、 碾 地 侦 奏 和 防 灾 救 险 等 领域 有 看 广泛 的 应 用 前 景 。 

首先 ， 新 型 仿生 六 足 机 器 人 可 答 代 士兵 执 行 危 险 使 合 。 它 能 代 蔡 十 兵 完 成 侦 听 、 监 视 、 
搜索 、 探 测 、 定 位 、 指 示 、 干 扰 等 任务 ， 可 有 效 你 护士 兵 生 命 ， 减 少 作战 人 员 伤亡 。 

其 次 ， 新 型 仿生 六 足 机 器 人 可 代 奉 人 在 恶劣 、 和 危险 或 人 不 可 达 的 环境 中 执行 任务 ， 如 在 
有 核 辐射 和 失 能 性 、 致 命 性 毒剂 场合 ， 痢 型 仿生 六 足 机 器 人 也 能 有 效 进行 工作 ， 从 而 你 证 特 
殊 任务 在 零 生 命 代 价 情况 下 顺利 完成 。 

再 次 ， 仿 生 六 足 机 器 人 体现 了 多 足 陈 机 器 人 设计 的 基本 思路 和 方法 ， 其 关键 技术 、 设 计 
理 您 、 实 验方 法 对 相关 的 机 硕 人 研发 项 目 及 机 左 人 教学 有 看 重要 的 借鉴 意义 。 
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(第 八 届 世纪 杯 北京 理工 大 学 课外 学 术科 技 作品 竞赛 一 等 奖 , 2011 年 ) 


[两 上 作品 研究 的 青 景 久 意义 


本 项 目 针对 眼镜 加 工 中 的 激光 点 焊 等 精密 加 工 环 太 ， 设 计 开 发 一 亚 基 于 ARM Cortex-M3 
核心 的 租 入 式 控制 工业 焊接 机 械 辟 ， 使 之 能 够 快速 、 精 准 、 高 效 、 智 能 地 完成 激光 点 焊 任 务 。 
在 控制 性 能 方面 达到 当代 焊接 机 械 臂 工业 产品 标准 的 同时 ， 着 重 在 系统 层面 进行 创新 突破 ， 
一 方面 在 机 械 结 构 上 严谨 设计 ， 引 入 闭环 平衡 锤 等 创新 结构 : 另 一 方面 在 控制 系统 上 实现 完 
善 的 艇 入 式 控制 功能 ， 加 强人 机 交互 性 ， 并 实现 多 机 智能 组 网 。 最 终 使 之 具有 实用 前 景 。 在 
此 研究 成 果 基 础 之 上 ， 可 以 方便 地 实现 功能 扩展 和 性 能 提升 ， 在 和 焊接、 法 配 、 喷 涂 或 对 刻 等 
工业 流水 线 操作 方面 有 着 广阔 的 应 用 空间 ， 可 满足 国内 企业 对 高 性 能 、 低 成 本 目 动 化 生产 设 
备 的 需要 。 


作品 概述 


6.2.1 ”人 研究 内 容 概述 

1.， 系统 结构 分 析 

“新 型 工业 焊接 机 械 恬 ”定位 为 解决 方案 层次 的 系统 设计 。 系 统 主要 包括 以 下 几 部 分 交互 
式 虚 拟 运 动 仿真 系统 、MATLAB 算法 建 模 系 统 、 骸 入 式 控制 系统 和 机 械 被 控 实 体 。 如 图 6-1 所 示 。 





















































便 件 调试 模块 


PWM 控制 信号 


机 械 被 控 实 体 





算法 C 代 码 移植 


硬件 接口 模块 


PWM 控制 信号 

骨 入 式 控 制 系统 PWM 控制 信号 
图 6-1 系统 工程 结构 网 络 图 

工程 前 期 ， 系 统 工程 以 交互 式 虚 拟 运 动 仿 中 系统 为 核心 ， 构 建交 互 式 可 视 化 的 虚拟 实验 
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平台 和 性 能 评估 系统 。 在 MATLAB 算法 建 模 系统 中 建 模 的 运 控 算 法 通过 软件 接口 模块 与 仿真 
系统 衔 拨 ， 通 过 仿真 系统 检测 算法 性 能 。 经 过 仿真 系统 校 验 的 成 熟 算法 ， 经 过 代码 翻 详 移 植 
入 馆 入 式 控制 系统 。 授 入 式 控制 系统 产生 的 控制 指令 经 过 便 件 接口 模块 进入 仿真 系统 ， 同 样 
经 过 仿真 系统 的 评 信 检验 。 

工程 后 期 ， 完 成 机 械 被 控 实 体 的 研制 MATLAB 算法 建 模 系统 与 嵌入 式 控 制 系统 产生 的 
控制 指令 可 以 通过 相应 接口 直接 控制 机 械 被 控 实 体 。 通 过 机 械 实 体 的 内 部 传 感 费 ， 将 实际 啊 
应 数据 送 入 仿 丰 系统 内 的 评估 函数 ， 进 行 实际 控制 效果 的 评估 与 校 验 。 

通过 以 上 两 个 过 程 最 终 完成 系统 整体 功能 的 实现 与 优化 ， 系 统 指令 流程 图 如 图 6-2 所 示 。 
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1 球 忆 
图 6-2 系统 指令 流程 图 

2. 控制 系统 需求 分 析 

工业 机 械 臂 的 控制 系统 主要 包括 以 下 儿 方 面 的 功能 : 

1 ) 电源 沪 理 :实现 整 机 的 电源 管理 ， 完 成 过 电压 过 电流 及 断 电 保护 功能 。 

2) 安全 防护 : 根据 现场 环境 条 件 能 够 实现 紧急 停机 等 保护 功能 。 

3) 何 服 张 动 : 实现 各 个 关 币 轴 驱 动 单元 的 位 置 、 速 度 、 力 和 矩 体 服 控制 。 

4) 运动 控制 : 多 轴 联 动 轨迹 规划 和 运动 学 计算 。 

5) 指令 存 取 : 针对 特定 数控 加 工 脚 本 指令 的 存 取 、 编 辑 及 详 但 转换 。 

6) 人 机 界面 : 实现 人 机 交互 ， 实 现 具 体操 作 功 能 。 

7) 通信 接口 及 忌 线 : 通过 PLC 等 市 点 指令 ， 完 成 多 机 协同 等 通信 功能 。 

控制 系统 在 架构 上 一 般 由 一 台 控 制 柜 和 相应 的 示 教 向 板 、 未 教 盒 组 成 。 控 制 柜 内 置 艇 入 
式 控制 系统 或 工控 PC， 还 包含 有 电源 管理 和 本 机 的 安全 防护 模块 ， 工 位 的 安全 防护 由 PLC 完 
成 。 示 教 面 板 或 示 教 使用 来 实现 人 机 操作 界面 ， 操 作 工 可 以 通过 面板 或 示 教 盒 完 成 相应 的 编 
程 和 操作 工作 。 

3. 平台 需求 分 析 

“新 型 机 械 辟 ”使 用 了 Dynamixel RX24F 骨 机 作为 天 六 驱动 单元 , 伺服 驱动 部 分 已 经 在 骨 
机 中 集成 ， 伺 服 驱 动 的 指令 通过 RS485 多 点 分 文 总 线 以 专 有 格式 的 数据 包 形 式 进 行 谈 写 。 所 
以 在 人 硬件 上 ， 控 制 系统 主要 实现 电源 管理 、 安 全 防护 、 运 动 探 制 、 指 令 存 取 、 人 机 界面 和 接 
口 通信 和 功能。 软件 方面 ， 控 制 系统 需要 实现 与 各 个 功能 相对 应 的 底层 使 件 张 动 程 序 ， 通 过 适 
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当 的 操作 系统 进行 系统 资源 调度 和 具体 功能 实现 。 

4. 算法 需求 分 析 

作为 实现 激光 点 焊 功 能 的 操作 臂 ， 要 求 机 械 臂 具有 良好 的 点 定位 功能 ， 并 具备 良好 的 路 
径 规划 能 力 ， 能 够 复 现 数控 加 工 脚本 指令 轨迹 。 针 对 这 些 要 求 ， 系 统 需 要 的 控制 算法 主要 是 
能 在 “新 型 机 械 臂 ”上 实现 快速 高 精度 的 正 运动 学 、 逆 运动 学 求解 算法 ， 以 及 能 够 处 理 速度 、 
加 速度 连续 问题 的 轨迹 规划 算法 ,并 且 能 通过 平台 直接 实现 NC 代码 的 译 码 ， 以 实现 实际 的 数 
控 加 工 任务 。 


6.2.2 ”技术 指标 


1) 工作 空间 范围 为 半径 50~300mm 的 球形 区 域 。 

2) 具有 9 上 自由 度 的 控制 自由 度 ， 包 括 关 节 6 自由 度 、 力 矩 控制 1 自由 度 、 末 端 执行 2 自 
由 度 ， 最 大 伺服 速度 300”/s， 人 伺服 分 状 率 小 于 0.32”。 

3) 重复 定位 精度 <0.5mm， 辟 展 300mm。 

4) 系统 指令 格式 为 CNC 代码 和 G 代码 ， 具 有 对 话 框 式 触 屏 操 作 界 面 。 


天 键 近 术 


6.3.1 机械 结构 设计 


1. 自由 度 配 置 

本 项 目 设计 的 工业 焊接 机 械 臂 机 械 部 分 没有 治 用 传统 焊接 机 械 臂 的 5 自由 度 机 构 ， 而 将 
自由 度 扩展 至 6 个 。 眼 镜 加 工 实际 过 程 中 ， 机 械 辟 夹 持 镜 架 ， 在 焊接 激光 束 下 移动 ， 因 此 对 
于 位 姿 和 位 置 控 制 具有 相同 的 精度 要 求 。6 目 由 度 操作 臂 在 其 灵巧 工作 空间 内 ， 对 于 目标 位 置 
和 位 姿 具 有 封闭 的 窗 盖 能 力 ， 加 上 和 额外 配置 的 力矩 补偿 控制 目 由 上 度 , “新 型 机 械 辟 ”为 6+1 目 
由 度 ， 属 于 7 轴 联 动 数控 加 工 操作 臂 。 主 体 的 自由 度 配 置 如 图 6-3 所 示 。 

在 图 6-3 中 ， 互 表示 各 个 目 由 度 关 和 旋转 轴 的 角速度 正方 问 单 位 矢量 。 操 作 臂 主体 为 6 
自由 度 开 链 串联 关节 坏 结 构 。 从 结构 上 可 分 为 基 座 、 第 一 级 臂 、 第 二 级 臂 、 腕 部 和 末 奖 执行 
器 五 个 部 分 。 由 基 座 向 末端 各 关节 依次 是 关节 1 〈 采 关节)、 关 节 2 〈 肩 关节 )、 关 节 3 〈 肘 关 
节 )、 关 节 4〔 腕 关节 一 )、 关 节 5〔( 腕 关节 二 )、 关 节 6( 腕 关节 三 )。 由 于 一 般 6 自由 度 机 械 
避 没 有 封闭 的 解析 解 ， 因 此 在 上 自由 上 度 配 置 的 过 程 中 需要 遵循 一 定 的 规则 ，Pieper 结构 是 6 上 自由 
度 工业 机 器 人 和 芝 用 的 一 种 上 自由 度 配 置 方式 ， 访 方式 研究 了 旋转 轴 交 与 一 点 的 三 个 相 邻 自由 度 
(对 于 运动 轴 相 互 平行 的 三 个 旋转 关 市 可 假设 交点 位 于 无 穷 远 处 ) 的 6 目 由 度 操作 臂 运 动 学 
问题 ， 借 由 轴线 交 于 一 点 的 三 个 相 邻 自由 度 形成 的 等 效 球形 副 ， 实 现 “ 腕 解 炸 ” 的 结构 ， 将 
运动 学 位 姿 关 系 中 的 位 置 约束 和 姿态 约束 相互 解 炎 ， 得 到 封闭 独立 的 位 置 和 姿态 解析 表达 式 。 

最 终 “ 新 型 机 械 辟 ”的 自由 配置 为 : 1、2、3 关节 轴线 可 落 于 同一 平面 内 ; 4、5、6 关节 
的 轴线 交 于 一 点 ， 构 成 “ 脐 解 看” 结构 ， 并 且 保 证 所 有 相 邻 天 节 旋 转轴 相互 平行 或 相互 正 交 。 
在 运动 学 上 构成 空间 定位 置 关 系 〈1、2、3 关节 ) 和 至 间 定 姿态 关系 “4、5、6 关节 ) 两 个 相 
互 解 灯 的 部 分 。 图 6-4 所 示 为 焊接 机 械 臂 前 期 演示 样机 结构 示意 及 腰 关 节 设 计 。 
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图 6-3 主体 的 日 由 上 度 配置 图 6-4 ”焊接 机 械 辟 前 期 尖 示 样机 结构 示意 及 腰 关 市 设计 
在 整 机 结构 设计 上 ， 力 求 采 用 创新 思路 ， 使 用 模块 化 、 多 功能 化 设计 方 采 ， 使 该 焊接 机 
械 辟 可 以 根据 需要 换 装 不 同 的 来 站 执行 部 件 ， 并 可 以 优化 重 配 目 由 上 度 。 
针对 操作 臂 串联 关 贡 结构 明确 以 下 几 个 设计 重点 : 
(1) 力矩 ”串联 操作 辟 为 时 变 非 线性 被 控 对 象 ， 在 力 辟 较 长 的 屑 天 市 3 引入 了 力 窍 团 环 控 
制 平 衡 锤 。 


(2) 惯量 矩 经 过 减速 器 ， 电 动机 承受 的 懂 量 乱 为 减速 比 的 一 ， 即 

















1 
H, 了 2 

因此 在 质量 设计 上 ， 以 力 窍 平衡 为 优先 设计 因素 ， 其 次 考虑 转动 惯量 分 布 。 在 可 能 的 前 
提 下 ， 将 质量 集中 在 转轴 处 降低 惯量 矩 。 

(3) 振动 的 级 联 放 大 级 联结 构 底 病 的 自由 度 的 刚性 和 强度 问题 造成 的 震 闸 与 重复 定位 
精度 误 产 ， 将 通过 目 由 上 度 之 间 的 串联 厢 合 和 机 械 结 构 上 的 杠杆 放大 作用 在 末 病 执行 机 构 。 因 | 
此 ， 基 座 腰 肩 关 键 关 节 的 结构 设计 成 为 机 械 结构 设计 的 重点 。 

针对 以 上 三 点 ， 最 终 决 定 的 造型 泻 染 图 和 原理 样机 如 图 6-5 和 图 6-6 所 示 。 
























































x : 全 
i 其 < 
一 人 a 
图 6-5 “新 型 工业 焊接 机 械 辟 ”造型 演 染 图 图 6-6 “新 型 工业 焊接 机 械 臂 ”原理 样机 





自由 度 配置 和 相应 的 杆 件 长 度 、 关 节 机 械 参数 就 可 以 约束 出 机 械 臂 的 实际 工作 空间 。 机 
械 辟 的 工作 空间 表示 了 机 械 臂 在 伺服 期 间 性 能 约束 和 机 械 结构 干涉 约束 下 的 未 端 执 行 器 可 达 
域 ， 只 有 在 工作 空间 范围 内 ， 机 械 辟 的 运动 学 研究 才 有 意义 ， 而 工作 空间 的 边缘 为 机 械 辟 的 
奇异 位 形 点 ， 在 运动 学 研究 中 需要 尽力 避免 。 图 6-7 和 图 6-8 所 示 分 别 为 “新 型 工业 焊接 机 
械 懂 ”xOz 平面 工作 空间 和 xOy 平面 工作 空间 。 
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图 6-7 “新 型 工业 焊接 机 械 辟 ”xOz 平面 工作 空间 ”图 6-8 “ 独 型 工业 焊接 机 械 锅 ”xOy 平面 工作 空间 


2， 结 构 设 计 

由 于 机 械 臂 运 动 部 件 众多 ， 且 运动 状态 经 常 改 变 ， 必 然 会 产生 冲击 和 振动 ， 采 用 最 小 运 
动 惯量 原则 进行 结构 设计 ， 可 以 增加 机 器 人 的 运动 平稳 性 ， 提 高 操作 机 动力 学 特性 。 为 此 设 
计 焊 接 机 械 臂 时， 在 满足 强度 和 刚度 的 前 提 下 ， 尽 量 减 小 运动 部 件 的 未 端 质量 ， 并 强化 运动 
部 件 对 转轴 的 质心 配置 。 同 时 要 求 本 设计 满足 一 定 工作 空间 要 求 ， 在 满足 运动 部 件 不 发 生 干 
涉 的 前 提 下 ， 通 过 尺度 优化 选 定 最 小 的 臂 杆 尺寸 。 本 项 目 设计 采用 塔 形 结构 ， 腰 关节 外 形 采 
用 锥 形 设计 ， 采 用 45 号 钢 ， 以 稳定 地 支撑 起 整个 结构 。 机 座 和 腰 关 节 的 连接 采用 双 轴 承 ， 推 
力 球 轴 承 位 于 竖 直 轴 下 端 ， 起 主要 的 承载 作用 ;， 深 沟 球 轴承 位 于 上 端 ， 起 对 心 导向 作用 。 这 
样 既 保 证 了 底部 舵 机 轴 的 对 中 性 ， 减 小 了 底部 的 振动 ， 又 增加 了 结构 强度 。 

肩 关 节 处 根据 其 载荷 和 运动 特点 ， 采 用 分 离 传动 。 将 舵 机 输出 轴 置 于 空心 承载 套 内 部 ， 承 
载 套 与 肩 架 固 连 。 空 心 承载 套 承受 径 向 力 和 轴 向 力 ， 并 将 力 传递 到 户 架 上 。 户 关节 舵 机 只 输出 
扭矩 ， 不 承受 轴 向 和 径 向 载荷 ， 这 样 减 少 了 能 机 的 负载 。 由 于 肩 轴 处 伸 出 ， 使 得 肘 关 节 以 上 部 
分 对 整个 结构 产生 偏心 距 ， 故 在 肩 臂 未 端 引入 可 自动 调节 的 配 重 体 ， 闭 环 平衡 锤 机 械 结构 如 图 
6-9 所 示 。 使 用 相同 能 机 及 丝 杠 螺母 结构 ， 通 过 舵 机 总 线 
上 电流 的 负 反馈 来 控制 配 重 体 移动 , 从 而 使 得 整个 机 械 以 
载荷 力矩 平衡 ， 形 成 对 肩 关 节 的 力矩 闭环 控制 。 肘 关节 、 
腕 关节 一 、 腕 关节 二 、 腕 关节 三 是 依次 作为 负载 起 作用 的 ， 
选用 高 强度 材料 ， 配 以 经 过 合理 力学 分 析 设计 的 减 重 孔 ， 
在 保证 结构 强度 的 前 提 下 ， 减 轻 零 部 件 的 质量 。 

在 机 械 辟 整体 造型 设计 上 ， 为 了 保证 腰 、 肩 部 分 的 
刚性 和 稳定 性 ， 应 使 其 结构 造型 趋 于 稳定 厚实 : 腕 关节 | 
部 分 在 保障 结构 强度 的 基础 上 ， 还 应 体现 轻 敬 灵 便 和 工 人 


@ 




























































































第 6 章 ”新 型 工业 焊接 机 械 辟 


业 寺 感 ， 造 型 风格 应 倾 问 曲面 为 主 。 网 6-10 所 示 为 第 二 代 使 用 无 刷 直 流 电 动机 的 焊接 机 械 辟 
结构 设计 方 采 齐 图 。 千 型 分 为 基本 功能 结构 造型 ， 以 及 基于 工业 设计 的 类 化 包 窗 造型 。 基 本 
功能 结构 为 空心 结构 架 ， 与 外 包罗 件 用 螺钉 连接 。 

















图 6-10 ”第 二 代 使 用 无 刷 直 流 电动 机 的 焊接 机 械 辟 结构 设计 方案 草 几 


3. 伺服 器 件 特性 

作为 本 科 生 的 创新 实验 项 目 ， 出 于 研究 经 费 和 成 本 考虑 ,“ 新 型 机 械 臂 ”无 法 使 用 高 性 能 
的 直流 无 刷 伺 服 电动 机 和 谐 波 齿轮 减速 器 来 设计 关节 驱动 单元 。 经 过 细致 的 多 方 考量 和 充分 
的 市 场 调研 ， 最 终 选 择 了 韩国 Dynamixel RX24F 机 器 人 能 机 作为 机 械 臂 的 关节 驱动 单元 ， 实 
物 图 如 图 6-11 所 示 。 其 具体 性 能 指标 如 下 : 

1) 重量 : 67g。 

2) 尺寸 : 35.5mmx50.8mmx41.8mm 。 

3) 分 辨 率 : 0.29” 。 

4) 减速 比 : 193:1。 

5) 堵 转 力矩 : 26kg.cm (在 12V，2.4Ah)。 

6) 伺服 角度 : 0” 一 300”《【 角 位 移 伺 服 模式 ); 360" 图 6-11 Dynamixel RX24F 机 咒 人 
(连续 转动 模式 )。 泥 机 实物 图 

7) 工作 温度 : -5 一 +8S'C 。 

8) 供电 电压 : 9 一 12V。 

9) 控制 信号 : 专 有 格式 数据 包 。 

10) 协议 类 型 RS485 异步 串 行 通信 (8 位 数据 位 ，1 位 停止 位 ， 无 奇偶 校 验 )。 

11) 物理 连接 : RS485 多 点 分 支 总 线 。 

12) ID: 254 ID (0~253), 

13) 通信 速率 : 7843bps 一 1Mbps。 

14) 反馈 : 位置 ， 温 度 ， 载 傈 ， 输 入 电压 。 

1$) 材料 : 全 金属 齿轮 ， 工 程 塑 料 壳 体 。 

16) 行 机 电流 : 50 mA。 

该 能 机 将 电动 机 、 电 动机 驱动 、 减 速 器 全 部 集成 ， 可 按照 回 有 的 数据 包 格 式 通过 RS485 总 线 
直接 控制 。R24F 艇 机 为 角 位 置 伺服 电动 机 ， 使 用 高 精度 塑料 电阻 式 角 位 置 传感器 进行 反 饿 ， 通 过 
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一 二 了 


10 位 AD 进行 采样 ， 实 际 位 置 分 辨 率 为 300° /1024 = 0.293" 。 通 过 内 建 算 法 间接 实现 了 无 量 纲 的 
速度 控制 〈 基 于 位 置 关 分 和 桥 路 电压 PWM 控制 方式 实现 ) 和 无 量 纲 的 力矩 控制 (基于 电流 环 控 
制 实 现 )。 可 以 针对 “新 型 机 械 臂 ”控制 特性 需要 进行 调整 的 控制 特性 曲线 如 图 6-12 所 示 。 

CW: 顺 时 针 位 置 环 


















CW: 顺 时 针 
x 轴 : 角 位 置 控 制 误 差 
CWW: 道 时 针 
y 轴 : 输出 力 算 

图 6-12” RX24F 骨 机 控制 特性 曲线 


在 图 6-12 中 ,具体 控制 特性 体现 在 6 个 区 段 。 E 表示 力矩 控制 输出 的 下 门限 值 ， 即 为 实际 输 
出 的 最 小 力矩 。B、C 表示 两 个 方 回 的 控制 误差 控制 下 门限 值 ， 当 角 位 置 误差 大 于 该 门限 值 时 ， 
位 置 环 才 开 始 休 整 ， 该 参数 对 应 控制 寄存 器 地 址 为 26 和 27 分 别 对 应 CW 和 CCW)， 可 通过 参 
数 调 整 ， 装 载 值 直接 对 应 A/D 采样 结果 ， 即 边界 值 1 对 应 0.293” 。 对 于 机 械 臂 来 说 ， 位 置 伺 服 
精度 为 第 一 关键 参数 ， 此 处 将 26、27 寄存 器 值 议 定 为 0， 即 实际 的 位 置 伺服 精度 为 0.293” 。A、 
D 段 对 应 力矩 /误差 控 制 斜 牵 ， 该 参数 对 应 控制 寄存 器 地 址 为 28 和 29 分别 对 应 CW 和 CCW )， 
对 该 寄存 器 的 操作 ， 相 当 于 改变 位 置 环 控制 占 的 系数 Kp， 和 直接 反应 控制 器 的 价 上 度 ， 增 大 该 系数 ， 
系统 啊 应 会 加 快 ， 但 是 会 市 来 超 调 震 沪 的 弊端 ; 减 小 参数 会 使 控制 过 程 更 加 稳定 平滑 ， 但 是 会 加 
大 控制 上 升 时 间 ， 造 成 幅 值 衰减 和 相位 游 后 ， 导 臻 丢失 控制 细 贡 。 访 参数 的 议定 需要 根据 实际 情 
况 具 体 整定 调整 。A、D 段 以 外 的 部 分 为 实际 输出 力 窍 的 上 限 ， 访 参数 对 应 控制 寄存 器 地 址 为 14 
和 15《〈 分 别 对 应 CW 和 CCW)， 对 该 寄存 器 的 操作 相当 于 了 控制 右 的 输出 限 幅 。 根据 以 上 控制 特 
性 分 析 可 得 ，RX24F 能 机 的 实际 控制 模型 为 具有 电流 限 幅 的 位 置 环 P 控制 器 。 


6.3.2 ”嵌入 式 控制 系统 设计 


“新 型 工业 焊接 机 械 恬 ”在 控制 方案 上 采用 了 基于 ARM Cortex-M3 的 单 亡 人 能 入 陈 控 制 系 
统 。 主 要 包括 便 件 设计 和 软件 设计 两 大 部 分 。 

1. 绊 入 式 硬 件 系 统 设计 

C1) 便 件 来 构 规 划 ”工业 机 避 人 现行 的 控制 系统 便 件 淋 构 主要 有 以 下 儿 种 ， 分 列 为 以 工 
控 机 为 核心 的 控制 系统 ， 以 PLC 为 控制 核心 的 控制 系统 和 完全 肉 入 式 控制 系统 。 

传统 的 便 件 系统 染 构 策略 以 工控 机 为 核心 的 控制 系统 使 用 工控 PC 和 相应 的 多 轴 运 动 控 
制 卡 实现 主要 的 控制 功能 。 该 种 架构 具有 性 能 强大 、 软 件 开发 及 维护 方便 、 人 机 界面 构造 科 
易 、 可 移植 性 和 泛 用 性 好 、 系 统 可 拓展 性 和 弹性 较 大 等 优点 。 但 是 务 势 也 很 如 普 ， 首 先 古 成 
本 局 别 ， 而 且 很 难 针对 被 控 对 象 的 特性 对 控制 系统 进行 裁 檀 来 控制 成 本 ;， 其次， 工控 PC 和 运 
控 卡 组 成 的 系统 体积 相对 较 大 ， 示 教 系统 个 便于 移动 使 用 ， 此 外 ， 工 控 机 系统 对 于 电源 和 工 
况 要求 相 对 较 启 ， 这 一 点 对 电源 管理 系统 将 产生 额外 的 成 本 。 

随 着 PLC 控制 性 能 的 提高 ,不 同类 型 的 PLC 都 采用 了 模块 化 设计 ， 其 中 比较 突出 的 有 日 
本 恒 河 公司 的 FA-M3 PLC， 模块 化 设计 的 PLC 十 分 便于 方案 设计 和 根据 成 本 进行 裁 前 。 对 于 
机 械 辟 控制， 利用 的 模块 为 : 电源 模块 、CPU 模块 、 位 置 控制 模块 、VO 模块 。 位 置 控制 模块 
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是 针对 机 械 臂 运动 控制 的 核心 部 分 ， 相 当 于 工控 机 架构 中 的 多 轴 运 控 卡 ， 可 以 在 PLC 中 直接 
实现 运动 学 计算 、 轨 迹 规划 和 原点 搜索 等 算法 。 

完全 的 区 入 式 控制 系统 是 近年 来 新 产生 的 一 种 机 器 人 控制 系统 架构 形式 ， 以 ARM、DSP 为 
代表 的 岁入 式 控制 器 的 性 能 日 益 强 大 ， 己 经 足以 满足 工业 机 器 人 多 轴 运 动 控 制 的 需要 。 早 期 的 完 
全 髓 入 式 控制 架构 受 限 于 CPU 的 性 能 ， 在 使 用 ARM 运行 操作 系统 的 同时 ， 往 往 需 要 辅 以 DSP 
或 者 FPGA 来 进行 数据 运算 和 多 轴 联 动 并 行 控 制 。 随 着 硬件 技术 的 继续 发 展 ， 尤 其 是 ARM 
Cortex-M 系列 32 位 工业 控制 IP 核 的 问世 ， 以 及 各 大 半导体 器 件 商 的 大 力 文 持 ， 产 生 了 以 NXP 
的 LPC3000 系 关 和 意 法 半导体 的 STM32 系列 为 代表 的 高 性 能 工控 MCU。 强 大 的 CPU、 功 能 完 
备 的 外 设 ， 再 加 上 独立 的 FPU( 浮 点 运算 单元 〉 等 高 性 能 的 运算 协 处 理 器 构成 的 MCU， 为 单 片 
藤 入 式 控制 系统 的 实现 提供 了 坚实 可 靠 的 硬件 支持 。 完 全 杉 入 式 控制 架构 具有 成 本 低廉 ， 架 构 极 
端 紧 凑 〈 甚 至 只 使 用 一 枚 MCU 配合 少数 接口 功能 IC 即 可 实现 功能 )， 架 构 适应 性 强 ， 可 随意 拓 
展 、 裁 注 。 缺点 是 相对 于 工控 机 和 PLC 架构 ,， 起步 阶 段 开 发 难度 较 大 ， 门 槛 高 ， 且 可 移植 性 较 差 。 

针对 本 作品 本 喘 定 位 为 低 成 本 的 小 型 操作 臂 ， 因 此 必须 对 成 本 进行 优先 考虑 ， 而 且 使 用 
PLC 和 工控 机 架构 ， 都 属于 应 用 开发 ， 不 涉及 底层 运 探 算法， 不 利于 技术 储备 。 绽 上 所 述 ， 
本 设计 最 终 选 择 了 完全 网 入 式 的 控制 系统 人 硬件 架构 。. 便 件 控制 系统 层级 染 构 图 如 图 6-13 所 示 。 
硬件 控制 系统 分 为 嵌入 式 控制 系统 和 上 位 机 系统 两 个 层级 。 其 中 先入 式 控 制 系统 在 单机 运作 
时 可 以 独立 工作 ， 当 多 机 协同 工作 时 ， 通 过 上 位 机 系统 进行 调度 和 统一 控制 。 






































































嵌入 式 控 制 系统 
IE 


图 6-13” 便 件 控制 系统 层级 淋 构 图 


(2) 硬件 功能 分 配 “确定 了 控制 系统 硬件 架构 后 ， 就 可 以 具体 展开 针对 硬件 控制 系统 的 
功能 性 设计 和 器 件 选 型 工作 。 首 先 针对 需求 分 析 的 六 个 功能 进行 功能 性 分 配 。 

1) 电源 管理 ， 电 源 主 要 负责 保障 机 械 辟 和 控制 系统 的 电源 供应 ,“ 新 型 机 械 辟 ”使 用 的 
RX24F 舵 机 使 用 的 是 12V 直流 供电 方案 , 控制 系统 使 用 的 5V 和 3.3V 电源 可 以 通过 12V 电源 
使 用 线性 稳 压 元 件 获得 ， 

2) 安全 防护 与 电源 管理 可 整合 设计 ， 通 过 独立 的 双 路 开关 和 串联 的 急 停 开关 实现 手动 的 
急 停 功 能 。 

3) 运动 控制 算法 在 实验 阶段 使 用 更 易 实现 系统 抽象 和 矩阵、 矢量 运算 的 Matlab m 语言 肢 
本 实现 ， 在 上 位 机 运行 ， 通 过 通信 接口 在 嵌入 式 控制 系统 进行 实物 仿真 。 后 期 调试 完成 后 ， 
经 过 m 语言 到 C 语言 的 算法 代码 翻译 ， 移 植 入 嵌入 式 控制 系统 运行 。 

4) 指令 存 取 主 要 包括 NC 代码 的 读 取 、 编 辑 和 译 码 ， 在 前 期 可 作为 运动 控制 的 一 部 分 ， 
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后 期 移植 入 对 入 式 控 制 系统 ， 需 要 解决 内 存 文件 读 写 的 问题 。 

5) 人 机 界面 可 以 通过 在 众 入 式 控 制 系统 中 外 挂 屏 幕 模块 的 方式 直接 实现 输出 显示 ， 输 入 
方面 对 于 效应 要 求 较 高 、 较 常用 的 指令 使 用 硬件 键盘 以 中 断 的 方式 实现 ， 对 于 操作 灵活 性 、 
交互 性 要 求 较 高 的 操作 部 分 由 触 屏 来 实现 。 

6) 接口 通信 方面 主要 对 控制 系统 提出 以 下 有 具体 功能 要 求 : 首先 是 针对 舵 机 通信 的 RS485 
异步 串 行 总 线 接口 ， 其 次 是 用 于 与 上 位 机 通信 调试 的 RS232 串 行 通信 接口 ;最 后 是 用 于 多 机 
协同 和 组 网 控制 的 LAN 以 太 网 接口 。 

(3) 器件 选 型 和 框架 设计 

1) MCU 选 型 : 首先 进行 戏 入 式 系统 核心 的 MCU 选 型 , 微 控 制 器 需要 具有 两 路 独立 的 UART 
通过 电 平 转换 来 分 别 实现 RS232 和 RS485 通信 ;需要 又 能 够 驱动 屏幕 的 16 位 高 速 并 行 总 线 ， 需 
要 具有 外 扩 flash 进行 数据 保存 的 扩展 性 能 ， 同 时 需要 有 能 够 在 MCU 执行 运动 控制 算法 的 性 能 。 
综合 以 上 儿 点 ， 最 终 选 定 意 法 半导体 公司 的 STM32F103VET6， 具 体 相关 性 能 参数 如 下 : 

Q@ 内 核 : ARM 32 位 的 Cortex“-M3 CPU， 最 高 72MHz 工作 频率 ， 在 存储 器 的 0 等 待 周 
期 访问 时 可 达 1.25DMips/MHz (Dhrystone 2.1)， 音 周期 滋 法 和 便 件 除法 。 

@ 存储 器 : 512K 字 节 的 闪存 程序 存储 器 ，64K 字 节 的 SRAM， 带 4 个 片 选 的 静态 存储 器 控制 
器 。 支 持 CF 卡 、SRAM、PSRAM、NOR 和 NAND 存储 器 。 并 行 LCD 接口 ， 兼 容 8080/6800 模式 。 

(8) ADC: 3 个 12 位 模 / 数 转换 器 ，lhs 转换 时 间 (多 达 21 个 输入 通道 )， 转 换 范 围 : 0 一 3.6V， 
三 倍 采样 和 保持 功能 ， 独 立 温 度 传 感 器 。 

@ DMA: 12 通道 DMA 控制 器 ， 支 持 的 外 设 : 定时 器 、ADC、DAC、SDIO、IS、SPT、 
FEC 和 USART。 

(@) 13 个 通信 接口 : 2 个 PC 接口 (支持 SMBus/PMBus);5 个 USART 接口 (支持 ISO7816， 
LIN，IrDA 接口 和 调制 解 调控 制 )，3 个 SPI 接口 (18Mbit/s)，2 个 可 复 用 为 PS 接口 ; 1 个 
CAN 接口 (2.0B 主动 ); 1 个 USB2.0 全 速 接 口 ，1 个 SDIO 接口 。 

2) 电源 系统 选 型 : 如 6.3.1 小 节 所 述 ，12V 额定 电压 下 ，RX24F 的 堵 转 电流 为 2.4A。 系 
统 的 极限 功 耗 〈 相 对 于 伺服 部 分 ， 控 制 系统 功 耗 可 以 忽略 不 计 ) 计算 如 下 

P=UmK =12Vx2.4Ax7x150% =302.4W 


式 中 ，7 为 驱动 单元 数 ,“ 新 型 机 械 臂 ”共有 7 个 目 由 度 ; K 为 功率 余 量 系数 ， 取 1.5 的 

电源 选用 12V、300W 的 AC-DC 开关 电源 ，5V 供电 使 用 DC-DC 功率 变换 模块 经 12V 电 
源 降 压 获得 ，3.3V 电源 使 用 LDO LM1117-3.3 经 SV 降 压 获得 。 

3) Flash 选 型 : 由 于 STM32F103VET6 具有 512Kob 的 板 载 flash， 所 以 硬件 驱动 程序 、 操 
作 系 统 和 运 控 算法 程序 可 以 实现 片 内 固化 。 但 是 NC 文件 需要 更 加 便捷 的 读 写 ,所 以 控制 系统 
仍然 需要 设计 独立 的 非 易 失 存 储 系 统 。 一般 咎 入 式 系 统 常 使 用 外 挂 的 了 C EEPROM 或 者 flash， 
或 者 使 用 CF、SD 等 具有 专用 接口 的 内 存 卡 来 作为 系统 的 扩展 存储 系统 。 对 于 使 用 STM32 作 
为 主 控 MCU 的 系统 ， 由 于 同时 有 使 用 屏幕 ， 需 要 占用 FSMC 并 行 总 线 ， 而 且 STM32 有 独立 
的 SDIO 接口 外 设 ， 具 有 直接 驱动 SD 2.0 协议 标准 设备 的 能 力 ， 所 以 内 存 不 宜 再 占用 系统 总 
线 。 因 此 本 设计 系统 最 终 采 用 符合 SD 2.0 协议 标准 ， 且 体积 更 小 的 TF 卡 作 为 存储 介质 。 

4) 屏幕 选 型 : 名 见 的 能 入 式 控 制 系统 使 用 的 触 屏 模块 有 320x240，480x272，800x480 几 种 分 
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状 率 ， 屏 幕 驱 动 蕊 片 常 见 的 为 ILI93xx 系列 或 SSD19xx 系列 ， 支 持 16 位 RGB565 颜色 编码 格式 。 
根据 实际 的 人 机 界面 设计 需要 ， 本 控制 系统 最 终 选 用 了 4.3 严 寸 480x272 分 辩 率 的 TFT 触 屏 模块 。 

5) 接口 模块 选 型 : STM32 具有 3 个 可 同时 使 用 的 UART 外 议 单 元 。 通 过 MAX3232 和 
MAX3485 进行 电 平 转换 后 直接 进行 RS232 和 RS485 通信 。 但 是 片上 没有 LAN 外 设 ， 所 以 为 
了 实现 以 太 网 通信 ， 需 要 额外 的 TCP/P 硬件 协议 栈 ， 本 控制 系统 选用 了 通过 SPI 总 线 驱 动 的 
以 太 网 控制 器 ENC28J60。 通 过 简单 的 外 围 电路 设计 和 具有 脉冲 变压器 的 HR911105A 网 线 插 
头 就 可 以 直接 工作 。 其 他 的 数字 量 、 模 拟 量 控 现 场 IO 由 STM32 IO 口 直接 驱动 。 

(4) 便 件 电路 设计 通过 人 硬件 选 型 ， 控 制 系 统 的 功能 分 配 已 经 完成 ， 之 后 开始 进入 具体 
的 功能 性 设计 和 实现 。 根 据 人 硬件 选 型 和 功能 分 配 建立 的 控制 系统 硬件 框图 如 图 6-14 所 示 。 


上 位 机 系统 
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图 6-14 控制 系统 便 件 框图 
硬件 控制 系统 PCB 设计 如 图 6-15 所 示 ， 原 理 图 如 图 6-16 所 示 。 








图 6-15 ”硬件 控制 系统 PCB 设计 
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图 6-16 人 硬件 控制 系统 原理 图 
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在 PCB 设计 过 程 中 ， 系 统 遵循 强 弱 电 共 存 的 EMC 设计 规则 ， 将 功率 地 和 控制 地 相互 隅 
离 ， 在 电源 处 通过 磁 珠 跨 接 一 点 接地 ， 磁 珠 等 效 一 个 固有 频率 可 变 的 电感 电阻 串联 系统 ， 比 
起 普通 的 电感 有 更 好 的 高 频 滤波 特性 ， 对 功率 地 线 上 的 高 频 文 波 串 扰 起 到 了 良好 的 扼 流 作 用 ， 
防止 其 对 控制 地 造成 干扰 , 造成 辟 件 损坏 或 总 线 通信 不 稳定 。 设 计 的 第 一 版 实验 系统 如 图 6-17 
所 示 。 
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图 6-17 第 一 版 实验 系统 


2. 机 入 式 软件 系统 设计 

散 入 式 控制 系统 的 功能 性 要 求 主要 包括 以 下 几 个 方面 : 

1) LCD、 触 屏 、 各 个 模块 接口 等 展 层 便 件 驱动 程序 。 

2) NC 代码 和 控制 指令 存 取 所 需 的 文件 系统 管理 程序 。 

3) 通 入 去 操作 系统 。 

4) GUI 界面 控制 。 

5) 超越 玫 数 和 和 埠 阵 运算 所 需 的 DSP 算法 。 

(1) 底层 便 件 驱动 设计 在 构建 压 层 便 件 驱动 时 ， 尺 可 能 地 使 用 了 STM32 丰富 强大 的 片 
内 外 设 ， 不 占用 CPU 资源 ， 不 使 用 CPU 模拟 任何 控制 风 辑 与 控制 时 序 。 将 CPU 完全 解放 给 
系统 层次 ， 以 进一步 提升 了 系统 的 实时 响应 性 。 该 部 分 具体 的 外 设 配 置 使 用 意 法 半导体 开发 
的 固件 库 STM32F10x_StdPeriph Lib V3.3 进行 设计 ， 以 适应 总 法 半 写 体 器 件 配置 守 存 器 众多 
的 特点 。 使 用 固件 库 配 置 外 设 的 一 般 步 又 为 : 定义 外 设 对 应 _InitStructure 初始 化 结构 体 ， 使 能 
外 设 和 对 应 IO 口 时 钟 ， 赋 值 相应 _InitStructure 结构 体 元 素 ， 使 用 _Init 函数 调用 相应 
_InitStructure 初始 化 外 设 。 之 后 束 可 以 通过 功能 函数 或 者 中 断 服务 使 用 外 设 功 能 。 

以 RS232 串口 配置 代码 为 例 。 

/定义 GPIO 配置 结构 体 

GPIO _ InitIypeDef GPIO InitStructure; 

/定义 USART 配置 结构 体 

USART InitTypeDef USART InitStructure; 

//GPIOB 与 USART3 时 钟 使 能 

RCC APB2PeriphClockCmd(RCC APB2Periph GPIOB, ENABLE); 

RCC APB1PerphClockCmd(RCC APBlPeriph USART3, ENABLE); 

/配置 USART3 Tx (PB.10) 为 复 用 推 挽 输出 模式 

GPIO InitStructure.GPIO Pm = OPIO Pin 10; 

GPIO InitStructure.GPIO Mode= GPIO Mode AF PP; 
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GPIO InitStructure.GPIO Speed = GPIO Speed SOMHz; 
GPIO Init(GPIOB, &GPIO InitStructure); 
/配置 USARTI1 Rx (PB.11) 为 悬空 输入 模式 
GPIO InitStructure.GPIO Pin = GOPIO_Pin 11; 
GPIO InitStructure.GPIO Mode= GPIO Mode IN FLOATING: 
GPIO Init(GPIOB, &GPIO InitStructure); 
/配置 USART 通信 参数 
USART InitStructure.USART BaudRate = 115200; 
USART InitStructure.USART WordLength= USART WordLength 8b; 
USART InitStructure.USART StopBits = USART StopBits 1; 
USART InitStructure.USART Parity = USART Party No; 
USART InitStructure.USART HardwareFlowControl =USART HardwareFlowControl None; 
USART InitStructure.USART Mode= USART Mode Rx| USART Mode Tx; 
USART Init(USART3, &USART InitStructure); 
// 使 能 USART3 
USART Cmd(USART3, ENABLE); 
全 此 USART 工作 模式 配置 结束 ， 对 应 的 功能 函数 调用 方式 为 〈 代 人 码 中 变量 ch 为 待 读 、 
号 unsigned char 类 型 变量 ): 
/USART3 单字 节 读 函数 
while(IUSART GetFlagStatus(USART3, USART FLAG RXNE)); 
ch=USART ReceiveData(USART3); 
/USART3 单字 节 写 函数 
while(USART GetFlagStatus(USART3, USART FLAG TC)== RESET); 
USART SendData(USART3, ch); 
其 他 外 设 的 配置 方式 原理 相同 ， 在 此 不 再 获 述 。 
(2) 文件 系统 管理 程序 移植 NC 代码 文件 为 .nc 格式 的 文本 文件 。 如 需 实 现 对 文本 文件 
的 局 效率 谈 写 编辑， 需要 在 从 入 式 系统 中 构建 文件 系统 。 本 软件 系统 通过 对 FATFS 开源 文件 
系统 库 进 行 移植 ， 在 系统 内 建立 了 FAT32 文件 系统 。FATFS 具有 紧凑 、 可 移植 性 好 等 特 操 ， 
只 需要 修改 diskio.c 下 的 disk read 与 disk_ write 两 个 函数 中 具体 指 问 的 设备 读 写 命令 , 即 可 完 
成 文件 系统 移植 。 通 过 建立 文件 系统 ， 一 方面 可 以 统一 高 效 的 进行 系统 内 的 数据 管理 ， 另 一 
方面 FAT32 在 PC 疹 有 民 好 的 文 持 ， 解 决 了 数据 接口 的 问题 。 
(3) 授 入 式 操作 系统 移植 ”针对 骨 入 式 控制 系统 中 任务 繁 傈 、 调 度 频 繁 的 特点 ， 在 般 入 
式 控 制 系统 内 需要 建立 操作 系统 进行 资源 调度 与 分 配 。 “新 型 机 械 避 ”作为 被 控 对 象 对 控制 系 
统 的 实时 性 有 严格 的 要 求 ， 最 终 在 操作 系统 选择 上 排除 了 WinCE 和 Linux， 选 择 了 骨 入 式 实 
时 操作 系统 uCOS/H， 以 你 证 系统 其 有 实时 的 中 断 啊 应 能 力 和 lms 的 事件 啊 应 能 力 〈 由 系统 时 
钟 Cortex-M3 时 钟 SysTick 决定 )， 且 对 任务 调度 有 便 实 时 性 的 约束 力 。 
(4) GUI 移 植 ” 艇 入 式 系 统 中 可 用 的 通用 GUI 库 效果 有 限 ， 而 且 往往 与 操作 系统 存在 一 
定 兼容 性 问题 ， 本 控制 系统 最 终 在 uCOS/II 实时 操作 系统 基础 之 上 上， 移植 了 与 忆 完 全 兼容 的 
uCGUI 图 形 界 面 系统 ， 可 以 建立 媲美 桌面 系统 的 对 话 框 界 面 和 各 种 GUI 控件 。 
(5) DSP 算法 实现 ” 运 控 算 法 是 嵌入 式 控制 系统 的 核心 部 分 。 现 行 的 主流 解决 方式 是 使 
用 DSP 做 协 处 理 ， 但 是 这 样 的 系统 设计 会 使 成 本 大 幅 增 加 ， 有 人 那 于 设计 体 约 局 效 的 单 片 柑 入 
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式 控制 系统 的 创新 理念 。Cortex-M3 的 指令 集 拥有 部 分 功能 强大 的 DSP 指令 , 直接 使 用 标准 C 
对 浮 点 数 进 行 运算 ， 并 不 能 有 效 地 利用 这 些 指令 资源 ， 结 果 会 造成 极 大 的 系统 资源 额外 开销 。 
因此 细 化 为 两 个 实现 层次 。 

1) 实现 层次 1 为 底层 超越 函数 的 实现 。STM32 在 72MHz 系统 中 使 用 标准 C 的 math 库 
进行 平方 根 运算 的 时 间 为 113ns。 以 50Hz 的 插 补 频 京 ， 远 远 不 能 满足 运动 学 计算 所 需要 的 运 
算 速 度 。 因 此 在 超越 函数 层 ， 本 设计 引入 了 德州 仪器 公司 为 Cortex-M3 核心 开发 的 IQMATH 
定点 函数 库 。 通 过 对 汇编 指令 的 优化 ， 将 运算 速度 提升 了 两 个 数量 级 。 移 植 后 包括 定点 数 格 
式 转 换 所 需 的 时 间 如 下 : 

QD 平方 根 运 算 时 间 : 3.48hs。 

@) 正弦 函数 运算 时 间 : 2.44hs。 

2) 实现 层次 2 为 上 层 和 矩阵 运算 层 。 通 过 对 CMSIS (Cortex M Software Interface Standard ) 
2.0 下 DSP 库 的 文 持 ， 实 现 了 涉及 运动 学 逆 解 的 各 种 矩阵 运算 函数 ， 使 得 运 控 系 统 上 只 有 更 强 的 
算法 描述 能 力 和 数学 建 模 能 力 。 

通过 以 上 途径 ， 在 组 入 式 控制 系统 中 实现 了 从 底层 人 硬件 驱动 到 算法 优化 的 全 部 软件 功能 。 
NC 代码 解码 的 操作 界面 如 图 6-18 所 示 。 








































































































图 6-18 在 嵌入 式 控制 系统 中 进行 NC 代码 解码 的 操作 界面 
6.3.3 ”运动 控制 算法 设计 


1. 运动 学 算法 设计 与 实现 

现代 工业 机 器 人 多 采用 在 线 编 程 的 方式 ， 要 求 在 满足 必需 的 精度 的 前 提 下 实现 较 快 的 速 
度 ， 这 就 使 得 作为 机 器 人 控制 基础 的 运动 学 问题 受到 越 来 越 多 的 重视 。 运 动 学 分 为 正 运 动 学 
和 逆 运 动 学 ， 前 者 一 般 采 用 齐 次 坐标 变换 法 ， 此 种 算法 简单 可 靠 ， 比 较 成 熟 。 后 者 由 于 机 天 
人 本 体 的 多 变性 ， 算 法 相对 复杂 ， 实 现 方式 也 多 种 多 样 。 

(1) 运动 学 模型 建立 ”进行 运动 控制 学 算法 设计 之 前 ， 必 须 首 先 对 被 控 对 象 机 械 臂 进行 数学 
模型 建 模 ， 对 于 开 链 串联 结构 的 多 目 由 度 机 械 臂 ， 一 般 使 用 一 种 名 为 DH (Denavit-Hartenberg) 
参数 模型 的 建 模 方 式 。DH 参数 描述 了 相 邻 杆 件 间 平 移 、 偶 移 、 旋 转 和 扭转 的 关系 ， 通 过 在 每 
个 天 和 处 的 杆 件 坐 标 系 建立 4x4 齐 次 变换 矩阵 ， 表 示 筷 与 前 一 杆 件 坐 标 系 的 位 姿 基 系 。 基 于 
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这 种 摘 述 方式 , 可 以 产生 多 种 DH 参数 建立 方式 , 这 里 使 用 修改 DH 参数 模型 (modified D-H)。 

建立 DH 参数 模型 的 第 一 步 古 建 并 各 个 关节 的 参考 坐标 系 。0O, - xm2o 是 与 固定 坐标 相连 
(一 般 为 大 地 坐标 系 〉 的 固 连 参考 坐标 系 ， 称 为 基 坐 标 系 。 0 一 xyz; 与 机 旧 人 的 第 i 个 杆 件 
相 固 连坐 标 原点 在 第 i+1 关 节 的 中 心 点 处 ， 即 相 邻 两 杆 件 的 交点 处 。 确定 和 建立 每 个 参考 从 
标 系 训 循 以 下 三 条 规则 : 

1) zi 轴 沿 看 第 i 关 届 的 运动 轴 。 

2) % 轴 垂直 于 zi 轴 及 zz 轴 并 指 问 离 开 2z1 轴 的 方 疝 。 

3) yy 轴 按 右手 坐标 系 的 要 求 建立 。 

通过 适当 的 位 形 调 整 ， 尺 量 保 证 在 坐标 系 建 并 过 程 中 各 参考 坐标 系 的 轴 指 问 相 同 ， 
这 样 可 以 简化 DH 参数 模型 的 建立 。 针 对 “新 型 机 械 篇 ”各 关节 的 参考 坐标 系 如 图 6-19 
所 未 。 
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图 6-19 各 关节 的 参考 坐标 系 
WO 
1) 9 : 两 连 杆 的 夹 角 ， 弓 z 轴 由 成 ， 旋转 到 忒 到 的 角度 。 
2) 4 ， 连 村 关节 轴 的 偏 距 ， 沿 > 轴 由 匹 “移动 到 下 到 的 距离 
3) a : 连 杆 的 长 度 ， 沿 z 由 2 移动 到 Z 的 距离 。 
4) ww : 连 杆 的 扭转 角 ， 沿 z, 轴 由 2 旋转 到 2 到 的 角度 。 
关系 中 ，Z2, 与 X, 表 示 对 应 轴 所 在 坐标 系 。 
对 于 转动 天 方 ，0 是 关节 变量 ， 其 余 为 天 和 参数 〈 第 数 ); 对 于 移动 和 天下 ，d 是 关 廊 变量 ， 
其 余 为 天 市 参数 。 
参考 6.3.1 小 市 “日 由 度 配置 ”中 的 定义 和 描述 , 在 各 关 市 处 建立 DH 参数 坐标 系 如 图 6-19 
所 示 ， 其 中 因为 天 和 $ 和 关节 6 坐标 系 原 点 建 模 重 合 ， 为 了 不 影响 标注 ， 关 六 6 的 坐标 系 用 
虚线 画 在 实际 位 置 右 侧 。 此 外 ， 区 淮 标 系 为 未 端 执行 器 的 工具 坐标 系 ， 根 据 未 端 执行 器 参数 
单独 引入 ， 不 影响 运动 学 求解 ， 构 造 的 ,相对 于 对 , ，a =50，Q = 和 元， 可 得 对 应 齐 次 变换 
阵 为 。 
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1 0 0 0 

es Eh (6-—1) 
” |0 0 -1 50 
0 0 0 1 





在 构建 好 的 各 关节 DH 人 举 标 系 基 础 之 上 上， 按照 如 上 上 所 述 规则 确定 基于 “新 型 机 械 臂 ”的 
DH 参数 见 表 6-1。 
表 6-1 “新 型 机 械 臂 ”的 DH 参数 模型 


| 0 
Ta 
ll | | 








完成 DH 参数 的 建立 后 ， 即 可 人 确定 对 于 “ 狐 型 机 械 恬 ”的 六 个 关 广 变量 QO、 色 、、 纺 、 
6; 、0 的 绝对 角 位 置 零点 与 角速度 方 同 ， 并 且 人 确定 机 械 辟 的 零点 位 形 。 

运动 学 正解 相对 比较 容易 ， 上 只 要 根据 运动 学 模型 ， 通 过 各 目 由 上 度 齐 次 变换 乍 阵 依 次 连续 
右 乘 ， 就 可 以 求 得 末端 执行 器 在 基 举 标 下 的 唯一 位 姿 。 而 运动 学 逆 解 是 在 已 知 来 奖 执 行 器 至 
间 位 姿 的 情况 下 ， 求 解 出 关 和 变量 ， 是 对 机 器 人 进行 有 效 控制 万 必 需 的 。 然 而 ， 运 动 学 逆 解 
的 求解 要 比 正 解 求解 复杂 得 多 ， 主 要 有 以 下 问题 : 

1) 可 解 性 : 求解 操作 辟 的 运动 学 方程 是 一 个 非 线性 问题 。 己 知 ,7 的 数值 , 试图 求 出 GQ 、 多 … 
0,; 通 音 这 种 方程 为 非 线 性 超越 方程 ， 特 列 是 当 G@ 不 是 0 或 x/2 时 ， 方程 非 第 复 傈 ， 很 难 求解 。 

2) 解 的 存在 性 : 解 是 否 存在 的 问题 完全 取决 于 操作 臂 的 工作 空间 。 人 简单 地 次， 工作 空间 
是 操作 句 末 奖 执 行 器 所 能 到 达 的 范围 。 

3) 多 重 解 问 题 : 在 求解 运动 学 方程 时 可 能 过 到 的 发 一 个 问题 就 是 多 重 解 问题 。 在 实际 情 
况 中 ， 经 单 会 出 现 机 械 臂 可 以 有 几 个 位 形 到 达 指 定 的 位 姿 ， 即 有 几 个 解 ， 而 控制 系统 只 能 选 
择 其 中 的 一 个 解 来 处 理 ， 这 里 面 涉及 选择 标准 问题 。 

现 阶段 主流 的 运动 学 逆 解 求解 方法 主要 有 以 下 两 种 : 

1) 对 于 Puma560 或 类 Puma560 等 符合 Pieper ;准则 的 机 器 人 ， 利 用 齐 次 变换 扎 阵 中 旋转 
了 矩阵 正 交 的 特性 ， 通 过 矢量 运 算 构造 方程 等 方法 提高 求 逆 解 的 速度 ， 实 现 对 逆 运 动 学 门 题 
的 解析 表达 式 。 

2) 由 于 机 费 人 的 生产 、 装 配 及 使 用 磨损 每 不 可 避免 地 会 市 来 误 产 ， 其 至 一 些 机 器 人 在 设 
计时 束 不 符合 Pieper 准则 。 和 针对 此 时 求解 困难 的 问题 ， 通 过 矢量 乘法 运算 找到 14 个 线性 无 关 
的 逆 运 动 学 方程 ， 利 用 分 离 变 量 消 元 法 将 逆 运 动 学 问题 向 化 为 天 和 变量 半角 正切 的 一 元 16 次 
方程 的 求 根 问题 ， 但 此 算法 得 到 的 运动 学 解 不 唯一 ， 需 要 进一步 验证 各 解 正 确 性 并 建立 取 优 
策略 ， 增 加 了 算法 运算 量 ， 将 局 部 搜索 能 力 强 的 模拟 退火 算法 与 全 局 搜索 能 力 强 的 遗传 算法 
相 结 合 提出 了 一 种 逆 运 动 学 解法 ， 虽 然 能 达到 一 定 的 精度 ， 但 程序 需要 占用 较 大 的 存储 空间 
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且 存 在 选 代 次 数 多 、 运 算 量 较 大 的 问题 ， 在 嵌入 式 系统 上 难以 达到 较 高 的 实时 性 。 

(2) 运动 学 正解 ”类 Puma560 等 符合 Pieper 准则 的 机 器 人 由 于 具有 解 看 的 位 置 与 位 姿 结 
构 ， 具 有 良好 的 解析 形式 ， 便 于 通过 解析 推导 计算 获得 逆 运 动 学 解析 解 。 为 了 进行 解析 推导 ， 
需要 正 运动 的 解析 表达 式 ， 基 于 “新 型 机 械 臂 ” 的 正 运动 学 解析 表达 式 推导 与 化 简 过 程 如 下 : 

根据 标准 DH 参数 模型 使 用 的 杆 件 模型 可 得 ， 一 般 杆 件 的 齐 次 变换 阵 形式 为 


























cos0 —sin0 0 这 
i SnOcosw | cosOcosw -Sn -sinQ,,d, (6-2) 
sinG sinQ,, cosOsinQ,, cosw， cosw Id 
0 0 0 ] 


陈 中 ，ci 为 cos0 的 缩写 ; 5 是 sing 的 缩写 ， 后 同 。 
代入 表 6-1 中 DH 参数 可 得 各 连 杆 齐 次 变换 和 矩阵。 


Cl —S] 0 0 

07 = Sl Cl 0 0 
0 0 1 0 

0 1 





0 
C3 =8;. :0.0 
. 0 0 1 0 
2 = 
= 03 0 0 
0 0 0 1 
6 .0 
3 -0 
a 
0 1 dd,; 
0 0 0 1 
Cx. = 0 .0 
0 0 1 dad 
7- 
= SC 0° 0 
0 0 0 1 
Cs Se ‘0: 改 
0 0 -1 0 
计生 
Ss 0 
0 0 0 1 
C2 ‘=8 ‘0: | 
0 0 1 0 
= 0 0 0 
0 0 0 1 
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将 以 上 各 个 连 杆 变换 和 宅 阵 连续 右 乘 ， 就 得 到 了 从 机 械 臂 基 坐 标 系 到 末 奖 腕 坐标 系 的 变换 矩阵 


i (6-3) 


其 中 : 

Nn, = SC48 一 9 CCCC3 — 01853) )—Cel Ss CCsS3 十 CC 一 Ci0818 + Ca CC C3 — C15583))) 
1 = —Ce( Ss( C81S3 十 C3818 2) + CsC C1S4 — Ca C2C351 — $15283))) — SeC C1C4 + SaC C2C351 — 815253)) 
Nn, = SysS6( C83 + C35)) — Co Ss CC3 — $583) tesCs C8 + C35,)) 

0, = SCSs CC + CC3S,) — CS Ss + CACCC3 — 018583))) + Ce C48) — SA CICs C3 — C18,83)) 
0, = SetSs( C2S1S3 + C35152) + Cs( C1S4 — CaC C2C381 — 8158253))) — CeC CiC4 + Sa CC351 — S15253)) 
5 

qd, =—Cs( CC,S3 十 OCS 一 94409184 + Ca C1CyC3 一 SS3)) 

0 = Ss C1S4 — Ca C2C351 — S815253) )— Cs CS1S3 + C35152) 

ad, =CSs( C83 + C35)) — Cs CC — S83) 

p, = QA3( CCC3 — C883) — da8) — da CCS3 + C1C38)) + qscic, 

py, = Cid3+as( C2C381 — 818253) — aC C381S3 + C35152) + QC 81 


p, =—4,s, — A3(C83 + C38,) — dC,Cs — S83) 





又 因为 关节 2 与 关节 3 的 轴线 平行 , 可 通过 与 的 两 角 合 角 公 式 化 简 ,。 设 人 ;= 人 B+ 全， 


将 co = cc3 一 9233 

5 

代入 上 述 方程 组 ， 得 

Nn, = S$6(C8) — $4C1Cy3) — Ce SsC1S 73 — Cs S184 + CaC1C73)) 
1 三 一 C648581823 + Cs( C1S4 — C451C23)) — SeC C1C4 + S451C23) 
,= (0 0 Ca 

0, = CC8) — $4C1C73) 十 SS — Cs Ss, + CaC1C23)) 
0, = 83608581823 + CsC C1S4 — C451C23)) — CeC C1C4 + S481C23) 
0, = SeCSsC23 + C4CsS23) + CoS 453 

a, 三 一 CjC1853 — S884 + CAC1C>3) 


a = (00 = C6) = C083) 
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4 > 一 54935523 CsC23 

Pp: = 03C1C23 — da3S1 — daCiS23 十 02CiC， 

Py = Cids + 0381C23 — daS1S23 + 02C231 

P; = 0S 一 03323 — daC3 

全 此 得 到 简化 后 便于 计算 与 求解 的 下 运动 祁 Te 

(3) 解析 法 求 运动 学 闻 解 ”利用 前 述 运 动 学 正解 算法 的 结果 式 (6-2)， 进 行 逆 运动 学 解 
析 推 导 求 解 的 算法 设计 过 程 如 下 : 

1) 解 @ 

由 运动 学 正解 式 〈6-3) 可 得 








n, o0o, a, p 可 
| Ne 

n, O: a, p 

0 0 0 1 





等 式 两 边 同时 左 乘 (%7)" 得 


1 l 1 1 
人 Bs CC oP 
1 Dp 
一 | 
CE PT (6-5) 
1 1 1 1 
Rs 6 Es 2 


1 

51 一 一 C6485823 一 C4C5C23) 一 8436C23 
1 一 一 

5 有 ,二 一 C436 一 C5C684 

N SS — Co SsCys + CaCssys) 
Nd 1 
LO =S (ss — CsCsCy3) — Cosac 
EO DO 0 40 654(4 23 
1 

50 ,二 6C53436 ~ Cace 

0O =8s(SsCs 十 ccsS) 十 CoS18 
,A 654523 
1 Cm 

6 一 一 5923 C495C23 

1 

1 

A Db 

1 
sob, = 0DC2 十 03C23 一 04823 

1 


1 
2 04C23 
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又 因为 齐 次 变换 阵 中 左上 角 的 3x3 旋转 变换 阵 为 正 交 矩阵 可 得 














c $s 0 0 
Be eo | Gh "0 0 证 
yn A 
(es ee 
0 0 0 1 
代入 式 《6-5) 得 
Cl $s 0 01107 0. 0 PP 
ne = 6 :0 n, 0, da, Pp, CE 
0 0 1 0lln o a, pp, 
0 0 0 1 八 0 0 0 1 
使 式 〈6-5) 与 式 〈6-7) 的 (2，4) 元 素 对 应 相等 得 
Sip: + Op, = ds (6-8) 
通过 三 角 恒 等 变形 得 
Pr =PCosY (6-9) 
p, =Psing (6-10) 
Es 
p=Vpi+p, (6-11) 
=arctan2(p,, p,) (6-12) 
将 式 (6-10) 和 式 (6-12) 代入 式 (6-8) 得 
-siCgs 十 clsy = Sin( 细 一 而 (6-13) 
p 
化 为 余弦 形式 避免 重 根 得 
2 
cos(O—0)=+ 园 (6-14) 
p 
一 
d | 
0-O =arctan2| 一 , 土 sj 和 | =arctan2 (ds, tp? + pi —d? | (6-15) 
O OO 
一 
0 =arctan 2(p,, p,)— arctan 2 ds, + pr: +p;— di | (6-16) 
2) 解 久 





已 解 得 和 ， 使 式 (6-5) 与 式 (6-7) 中 (1，4) 元 素 和 (3，4) 元 素 分 别 对 应 相等 ， 可 得 


© 
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1 
CIPS FOIDy OF = qc, + 03C23 一 04823 


1 
ps 二 一 
ps oF 2 


将 式 (6-17) 和 式 (6-18) 平方 和 后 相 加 


$2 一 03323 一 04C23 


得 


> 2 

pr +p,+p;: -a -a3 -4d3—d 

| 本 0 
20， 


可 得 











式 (6-20) 与 式 (6-13) 相同 ， 用 同样 的 


三 角 恒 等 变换 可 解 得 


0 = arctan 2( 4;, 4d) -arctan2(K,+ Va + ds -K’) 








3) 解 包 
由 运动 学 正解 可 得 
CC23 一 
SS 一 
ne 
一 923 
0 
C1523 
本 一 C1S23 
一 (37) = 
= 
0 
和 章 新 整理 式 (6-5) 可 得 
C1C23 S1523 S523 
(TT = 一 (C1923 T3123 C23 
-0 CI 0 
0 0 0 


CG 
a 695 
= 条 人 | 
C4S4 — CsCesS, 


0 


CS -S| 000C — dasI 
$587%3 CC Cd;+ac,s 
一 C23 0 US 

0 0 ] 

S1523 S33 UC3 

S1523 C23 53 

0 0 ] 

一 42 C3 nn, OV Ud 
Qsy Nn, 0o, a, 
—d; nn, 02: 4d, 

] 0 0 
5 Cs 
0 0 


1 





(6-17) 


(6-18) 


(6-19) 


(6-20) 


(6-21) 


(6-22) 


(6-23) 


(6-24) 


(6-25) 


令 式 (6-24) 与 式 《6-25) 中 两 矩阵 〈1，4) 元 素 和 “(2，4) 元 素 分 别 对 应 相等 ， 可 得 


CiC23 Px + S123Py 


CS23Px S123 Dy 


S23Pz: 42C3 二 0 


-CaP +a,S3 = di 


© 





(6-26) 


(6-27) 
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联 立 式 (6-26) 与 式 〈6-27) 可 解 得 


(ay T0760) D+ (opt Dp ds 


$23 一 


(6-28 
(cp; +s1py) + ps 


(= 
人 


(6-29 
Cop; SP 十 及 


式 (6-28) 与 式 〈6-29) 分 母 为 正 ， 可 通过 四 象限 反正 切 求 得 & 与 2 的 合 角 0;。 


Os =arctan 2(—[(a; + Qc3) DZz+CcP TSP ds 一 5) 





(6-30) 
Ke /I TR ge eo) 
可 解 得 色 
0 =0 -0 (6-31) 
根据 0 与 的 解 的 四 种 组 合 形 式 ， 久 解 有 四 种 可 能 形式 。 
4) 解 
式 (6-24) 完全 已 知 ， 令 矩阵 中 (1，3) 元 素 和 (3，3) 元 素 分 别 对 应 相等 可 得 
C1C230x 十 S19230) — $230, 二 一 C485 (6-32 ) 
= ,= (6-33) 


当 sinQ. 关 0 时 ， 可 解 得 0 。 
0, =arctan 2(— sa, + CQ 一 CI1C230 — S1S230, + Sa (6-34 ) 
当 4 =0 时 ， 操 作 尼 处 于 位 形 奇 卉 点 ， 此 时 关 人 4 与 大 6 轴线 重合 ， 发 生 目 由 度 退化 现 
象 (第 4 目 由 度 与 第 6 目 由 度 退化 为 一 个 目 由 上 度 )。 这 种 情况 下 , 可 通过 检 奉 式 (6-34) 中 arctan 2 
国 数 的 两 个 变量 是 否 都 趋 近 于 零 来 判 新 。 如 条 趋 近 于 堆 ， 此 时 的 和 可 任意 选取 《一 般 选 取 上 
一 次 的 计算 值 )， 之 后 计算 多 时， 可 根据 和 进行 选取 。 














5) 解 Q 
习作 玉生 口 4 日 
由 久 求 解 过 程 可 得 
SiS4 tCaCiCyy CaS1—SaCiCx3 CS23 QaC1iCy3 ~ das! — dacisy3 + QC1C 
0m _ 073 C431C23 一 CS4 CC 一 S431C23 SiS23 Cid3 十 0331C23 一 04831823 + QC 
a = 7 = (6-35) 
C4%23 54523 0 一 02S? 一 03323 — dacys 
0 0 0 1 
SiS4a 十 C4C1C3 CaSiC3 CS4 Casy3 ~A3C3C4 + dss4 — a3c4 
it dy OC SS QC Cds TGss 
0 4 CCS I Ca M3 DC AY 
0 I 0 ~d4 十 0D33 
0 0 0 ] 


再 次 改写 式 (6-5) 
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(10 Ree 








SiS4a 十 C4CIC3 CaSiC3 CS4 Casy3 aCCa tdys4 一 CO， Qa: PD: 
C481 一 S4CIC3 一 CIC4 一 S48S1C3 S43 QC3s4 +Cd3 tas3sy |In, 0o, a, Pp (6-37) 
0 ST Co 一 04 + 0D 33 1 
0 0 0 1 0 0 0 1 
CCe “SCs “S65 0 
S C 0 0 
T= (6-38) 
Ot Bde Ce 0 
0 0 0 1 
令 式 (6-37) 与 式 〈6-38) 两 矩阵 (1，3) 元 素 和 《3，3) 元 素 分 别 对 应 相等 ， 可 得 
Ke) a, 一 C482307 一 一 95 (6-39) 


CS230 一 3192345234 2 二 C5 


可 解 得 @ 


(6-40) 


0,=arctan 多 一 (884 + CaciC23) Gs 一 《4c481C23 — C154) Gy + C482302 C830 — S15230, — Cx30s) (6-41) 





6) 解 %。 

由 0 求解 过 程 可 得 
0 
人 
-7 

sl 

sHi, 
0 


- 

dn 一 CC +cCc)— SSCs 
sh = Cs\S1S4 十 C4C1C23 5C1S23 
0 

5 


WD CC CNS1C 
0 

ss 一 一 35C23 一 54C5523 
人 
sO Se1D93 5 和 5154 ep: 
上 OO =s(C8, — Cs cs)— Css 
SO CA 591023 
0 Ws, 一 
0 

0 En 一 一 

5Q .一 54C1C23 C4%1 

My =ec,+ 

5 一 2154 S41C23 

0 

9 

0 

spP, 4303 dss1 一 d4C1S23 + QscC1C 


0 
CO ， sd, 
O 0 
y 3 y 
0 
0 5C 
0 0 


(6-42) 
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0 
sp, = Cid3 + 038S1C23 — daS1S23 + 02C281 


0 
Ey Soe 0d4C23 


0 / 0 ,J 0 / 0 / 
a 50 ss sh, 
0 / 0 / 0 / 0 / 
(Le Sy By Wp Ey (6-43 ) 
0 J, 0  / 0 / 0 / 
SU 0 a Ss 


其 中 


Nn =csCsiss 十 )— 
SD AC ee 
5 了 二 一 C5C1323 — SsCS Ss 十 C4CIC25) 
人 四 

5 用， 一 546 和 《41 

0 = SC ) 
2 
-O “= $s Cs 一 )— 
0 4 8 
0 

SN Np 

0 一 一 一 ~ 一 一 

5Q .一 55523 (54055523 

0 
5 
0 
5 
0 


/ ee EE 
人 一 C4955523 一 C5C23 


,全 
全 和 


0 四 二 
4 


再 次 改写 式 (6-5) 


2 / 0 / 9 / 0 / 
2 i ss A O: a. Px 
9 / 有 / “7 / -站 / 
n O a p 
0 —]0 5 5 5 5 人 
(2977 oT = y y y y ”7 f= 洒 (6-44) 
说 / 9 / 0 / DD / Nn, 0, Ud, ps 
5S Z 人 5 落 5S Z 
0 0 0 l 








令 式 《6-44) 左右 两 边 〈1，1) 元 聚 和 (3，1) 元 素 分 别 对 应 相 每， 可 得 


CCsCS1S4 + C4C1C23) — 85C1523) We —( S581S23 + Cs( C1S4 — C481C23)) 7 一 《85C23 + C4C5823) Ns = C6 (6-45) 


CS4aC1C23 — C451) 1 + (CC4 + S451C23) 1 — S4823Ns = 一 S6 (6-46) 
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联 立 式 (6-45) 和 式 《6-46) 可 解 得 
arctan 2Cs,, cao) (6-47) 
其 中 
9. (GC ON) Me ( COF SC nn, + $aS23n, (6-48) 
C6 = (csCS184 tO N03) M(t C(O CY ) nn, 一 (BC CC (6-49) 


7) 多 解 整 理 。 由 于 在 式 (6-14) 与 式 (6-21) 中 出 现 +， 因 此 目前 方程 组 可 能 有 4 组 解 。 
为 外 三 个 币 线 交 于 一 扩 的 腕 关 所 形成 的 球形 副 的 “翻转 ”会 产生 两 种 g，g ，g 的 组 合 ， 可 


以 得 到 另外 的 4 组 解 。 球 形 副 翻转 形式 如 下 














0, =O+X (6-50) 
0, =-0. (6-51) 
0. =0,.+7n (6-52) 





至 此 ， 六 自由 度 串联 结构 腕 解 厢 型 机 械 辟 的 所 有 8 组 逆 运 动 学 的 解 的 形式 都 已 解 得 ， 根 
据 关节 运动 范围 和 工作 空间 的 约束 ， 其 中 一 些 (其 至 全 部 ) 解 要 被 舍弃 ， 在 剩 下 的 解 中 ， 通 
常 根据 位 置 或 能 量 最 小 变化 原则 ， 选 取 与 上 一 位 姿 最 为 接近 的 解 。 

(4) 牛顿 -拉夫 逊 迭 代 法 求 运动 学 道 解 ” 运 动 学 首 解 问题 中 的 两 个 关键 问题 为 解 的 存在 问 
题 和 多 解 问题 。 对 于 工作 空间 边界 点 等 具有 奇异 性 质 的 问题 时 ， 需 要 一 种 不 需要 考虑 多 解 问 
题 的 逆 解 求解 形式 。 

牛顿 -拉夫 进 迭 代 法 求解 运动 学 道 解 的 算法 基础 为 ， 以 雅 可 比 矩 阵 和 微分 运动 为 基础 ， 采 
用 基于 豪 斯 霍 尔 德 的 SVD 分 解 求 雅 可 比 矩 阵 的 伪 逆 来 解决 奇异 性 问题 ， 通 过 兴 代 可 以 得 到 逆 
运动 学 的 唯一 解 ， 此 解 等 同 于 按 能 量 最 小 原则 确定 的 最 终 解 。 算 法 参数 和 所 需 存 储 空间 均 较 
少 ， 借 助 牛顿 -拉夫 逊 迭 代 法 的 局 部 快速 收敛 性 ， 以 较 少 的 迭代 次 数 即 可 得 到 所 需 精度 的 解 。 
而 且 ， 当 机 械 辟 结构 发 生变 化 ， 不 具备 腕 解梦 条 件 后 ， 解 析 法 有 可 能 难于 求解 甚至 完全 失效 。 
此 时 ， 基 于 牛顿 -拉夫 逊 迭 代 法 的 求解 方式 仍然 有 效 适 用 。 因 此 ， 该 方法 对 于 研究 工业 机 器 人 
的 运动 学 控制 具有 重要 的 意义 。 

“新 型 工业 焊接 机 械 辟 ”的 牛顿 -拉夫 进 迭 代 运 动 学 道 解 算法 流程 如 图 6-20 所 示 。 和 牛顿- 
拉夫 逊 迭 代 运动 学 着 解 算法 是 一 种 以 机 械 辟 DH 参数 、 以 章 次 变换 矩阵 给 出 的 目标 位 姿 信息 
7 和 初始 关节 空间 位 置 go 为 输入 量 ， 经 过 迭代 计算 ， 最 终 给 出 关节 空间 位 置 矢 量 9 的 算法 。 
算法 主要 包含 以 下 求解 步骤 ， 

1) 求解 wu。 使 用 9 (算法 启动 时 使 用 go) 代入 运动 学 正解 求解 当前 位 姿 Du (以 齐 次 变 
换 阵 形式 给 出 ) 



















































































q =|[0, 已， 0 0,, 0 0. | (6-53) 


fkine(qg) = "7( 0)17( 0,)7( 0)7( 0,)47( 6,)57( 0,) (606-54) 


sineg) el 2 “2 (6-55) 
n, O: a, p; 
0 0 0 1 
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命 运动 学 ee ek ee 
输入 目标 位 次 输入 初始 位 次 g 


上 限 达 代 次 数 
miimit=1000 
收敛 条 件 算法 初始 化 


stol=0.01 
迭代 次 数 m=0 
当前 位 姿 7 迭 代 
q=4q+dgq 
Ti 到 TT 的 微分 
运动 矢量 万 
nm=|dgq| 


正 运 动 学 雅 可 比 矩 阵 





J 和 其 违 逆 J* 


m+=1 
关节 角 微 分 增 量 加 
Y 


dg= (J *) D 







报错 : 
解 不 收敛 


和 迭代 法 求 道 解 结束 
图 6-20 “牛顿 -拉夫 进 运 代 运 动 学 赣 解 算法 流程 


2) 求解 微分 运动 天 量 D。 微 分 运动 天 量 DD 一 般 可 以 表示 为 微分 移动 天 量 d 和 微分 转动 天 
量 6， 分 别 可 以 表示 为 





d=ditd,j+d,k (6-56) 
O=0.i+0,j+0.k (6-57) 
将 两 个 天 量 合并 为 一 个 六 维 矢量 D， 称 其 为 刚体 相对 于 基 坐 标 系 的 微分 运动 天 量 。 


d 
D=[d,, d,, d,,， 0 ， 0 5T-| 3 (6-S8 ) 


通过 求 对 于 特定 变换 阵 7 的 变换 微分 来 确定 微分 运动 矢量 。 
7+d7=Ttrans (qd) rot (O) (6-59) 


式 中 ， 
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1 0 0 ad, 
0 1 0 dad 
trans (d)= y 
0 0 1 dad, 
0 0 0 1 
1 -Oo, 0， 0 
0O 1 -0 0 
rot (0O)=| “ : 
-6, 6 1 0 
0 0 0 1 
一 > 
0 -0o, 0， Q 
0O 0 -0 QI 
d7=7Ttrans(Cd)rot(O) 一 1]=7 < * 
[trans( dq jro ,| A 了 人 





其 中 4 为 4x4 的 单位 阵 。 用 微分 算 子 V 稍 化 表示 


0 -0O. 0， d, 

0 0 -6 dd 

V=trans(d)rot(0)—1,=| . xX oy 
-0, 0, 0 dd, 


0 0 0 0 
求解 从 TT,, 到 工 的 变换 微分 为 


> V=7T,, 7 -1 
联 立 式 (6-63) 与 式 (6-65) 可 解 得 


Pi — Po 
A 可 
0 XW, 十 0, XO 本 化 X a) 


式 中 ， 严 、0 、a 、p 为 齐 次 变换 阵 中 对 应 的 列 向 量 。 








3) 求解 雅 可 比 矩 阵 了 了。 机械 辟 雅 可 比 矩 阵 了 通常 是 指 从 关节 空间 向 侍 卡 


的 广义 传动 比 。 即 
V=x=J(g) qd 
陈 中 ， 浆 佛 卡尔 空间 速度 天 量 ，9 为 天 节 速 度 矢量 。 
作 卡 尔 空间 速度 用 微分 运动 天 量 表示 为 











联 立 式 (6-67) 与 式 (6-68) 可 得 


©@ 


(6-60) 


(6-61) 


(6-62) 


(6-63) 


(6-64) 
(6-65) 


(6-66) 


间 运 动 速度 


(6-67) 


(6-68) 
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lim 4 1D 《0-09 ) 
Al 一 0 At 
> 万 =. 作 9)d9 (6-70) 
(D 求解 相对 于 工具 坐标 系 的 雅 可 比 算 阵 J 。 机械 辟 雅 可 比 变换 矩阵 可 以 写成 分 块 第 阵 的 
形式 
d Ya Ja | 
= . d (6-71) 
上 的 .5 ss 





在 建立 DH 参数 时 ， 旋 转 关 节 的 旋转 轴 定 义 为 = 轴 ， 雅 可 比 窍 阵 可 以 利用 微分 变换 的 方式 
求解 ， 对 于 旋转 关节 i ， 连 杆 相对 于 连 杆 ;一 1 绕 坐 标 轴 z 做 微分 转动 49 ， 则 关节 坐标 系 的 


0 0 0 
d=|0|15=|0jde =|0 (6-72 ) 
0 1 6. 


微分 运动 矢量 的 等 价 坐标 变换 式 如 下 
TD 7 |p (6273) 


式 〈6-73) 表示 根据 当前 坐标 系 人 微分 运动 矢量 D ， 可 以 通过 变换 得 相对 于 变换 阵 了 坐标 
系 的 微分 运动 矢量 D 。 式 中 

















n. OO。 da, 0 p: Db, 
R=|n, o0o, a,|Sp=| p, 0 -p, (6-74) 
Nn, O: 242 -Py x 0 
将 式 (6-72) 代入 式 (6-73) 得 : 
(pxn) 
(pxo) 
和 (pxa), 
De d0. (6-75) 








式 中 ，n 、0o、a、p 为 变换 阵 T 的 相应 列 癌 量 。 因 此 ， 式 (6-75) 中 列 元 素 可 表示 为 


(pxm, -np, +n,p, 7 
J =| (pxXo), | =| -op, +ovP， | (6-70 ) 


(pxoa), -a.p, 十 OP 





Ud 


式 中 ，n、o、a、Dp 为 变换 阵 %7 的 相应 列 问 量 。 
建立 求解 末 剖 执行 莫 的 雅 可 比 矩 阵 了 了 算法， 流程 图 如 图 6-21 所 示 。 


四 
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具 愉 村 答 入 变换 答 阵 。 /给 入 初始 位 次 
/ emer /ra 0 


Ce 


/= Da 


| 口 
临时 变量 
根据 7， 求 7 (7 ) 
保存 J (n) 到 J 
- 
Y 
求解 结束 


图 6-21 求解 雅 可 比 窍 阵 .7 算法 流程 图 


通过 该 算法 即 可 解 得 相对 于 工具 坐标 系 的 雅 可 比 窍 阵 .7 。 
G@) 求解 相对 于 基 坐 标 系 的 雅 可 比 窍 阵 7 已 求 得 相对 于 工具 坐标 系 的 雅 可 比 窍 阵 .6。 通 
过 雅 可 比 和 矩阵 的 参考 系 变换 ， 可 以 变换 获得 相对 于 基 举 标 系 的 雅 可 比 和 矩阵 .7。 雅 可 比 矩 阵 的 参 











考 系 变换 公式 如 下 
AR 0 
up 一 B 3 (6-77) 
0 4R 
IR 0 
二 = /一 6 yh 一 


a. 求解 的 广义 逆 J*+ ”首先 对 J 进行 基于 聚 斯 霍 尔 德 的 SVD 分解 
J =UZV (6-79 ) 

式 中 ，U 为 酉 符 阵 ， 了 为 一 个 半 正 定 对 角 阵 ， 矿 为 严 的 共 斩 转 置 ， 为 西 和 矩阵 。 
通过 对 SVD 分 解 的 形式 进行 变形 ， 获 得 7 了 的 伪 逆 .三 

J+=UY'V (6-80 ) 
式 中 ，z 为 将 荆 转 置 ， 并 将 其 主 对 角 线 上 每 个 非 堆 元素 都 求 倒 数 得 到 的 。 
b. 求解 天 市 空间 微分 运动 矢量 dg 
由 式 (6-70) 得 到 














dg = .CgO)D (6-81) 


可 直接 解 得 关节 空间 微分 运动 矢量 dy 。 
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c. 计算 ldgl| 
关节 空间 运动 微分 矢量 dg 的 变化 误差 由 dg 的 方 均 根 |dd| 来 评估 


ldq|= Vd&2 +d62 +d62 +d62 +d62 + dO, (6-82) 

此 处 dq| 的 物理 意义 为 多 维 空间 内 向 量 dy 的 泛 数 ， 充 分 反映 了 误差 的 情况 。 通 过 设 定 一 个 
收敛 误差 限 ， 即 一 个 满足 精度 的 充分 小 的 数 stol 。 当 |dq| < stol 时 ， 退 出 循环 并 输出 当前 关节 空间 
位 置 9;， 当 循环 次 数 大 于 mz 时 ， 循 环 结束 并 输出 错误 信息 ， 其 中 ，1i 为 满足 预订 和 迭代 次 数 要 
求 的 自 定义 充分 大 的 整数 ， 当 |dqa| > stol 且 循 环 次 数 m<mr 时 ， 令 9=9+d9 进行 迭代 计算 ， 重 
复 步骤 (1) 至 (6)， 直 到 满足 循环 退出 条 件 ， 此 时 gq 即 为 满足 条 件 的 机 械 臂 各 天- 角度 。 

2. 轨迹 规划 算法 设计 与 实现 

(1) 轨迹 规划 算法 概述 ”运动 轨迹 用 以 描述 机 械 臂 在 三 维 空间 内 随时 间 实 现 期 望 运动 的 过 
程 。 机 械 臂 的 轨迹 具体 来 说 ， 指 的 是 每 一 个 自由 度 的 在 同一 时 间 坐 标 下 的 位 置 、 速 度 与 加 速度 。 

如 逆 运 动 学 算法 设计 过 程 所 示 ， 由 于 机 械 臂 的 运动 控制 涉及 复杂 的 中 间 计 算 过 程 。 因 此 ， 
通过 直接 的 关节 空间 命令 ， 往 往 难 以 实现 准确 可 靠 的 轨迹 描述 。 为 了 使 机 械 臂 便于 使 用 ， 不 
应 当 要 求 用 户 预 估 到 正 运动 学 的 结果 ， 然 后 通过 复杂 的 关节 空间 对 时 间 的 函数 来 完成 机 械 辟 
控制 ， 而 应 该 由 用 户 简单 指定 一 些 目标 位 姿 点 ， 由 控制 系统 自动 完成 具体 计算 过 程 。 

因此 ， 机 械 臂 的 轨迹 规划 ， 有 共 体 指 由 用 户 指定 时 间 坐 标 和 末端 执行 器 的 期 望 位 姿 信息 ， 
通过 控制 系统 来 获取 达到 期 望 位 姿 的 精确 路 径 、 速 度 和 加 速度 曲线 等 的 过 程 。 针 对 这 一 过 程 
除了 要 建立 精确 的 数学 模型 和 算法 之 外 ， 还 要 考虑 具体 的 算法 实现 方式 ， 以 保证 轨迹 可 以 在 
数字 系统 内 正确 、 实 时 地 进行 计算 ， 并 能 够 达到 足够 控制 精度 水 平 的 控制 频率 ， 典 型 的 操作 
辟 系 统 中 ， 路 径 更 新 率 为 60 一 2000Hz。 

工业 机 器 人 领域 通过 插 补 的 方法 进行 机 械 辟 等 机 器 人 的 轨迹 规划 。 插 补 是 根据 给 定 的 数 
学 函数 ， 在 理想 的 轨迹 式 轮廓 上 的 已 知 点 之 间 ， 确 定 一 些 中 间 点 的 一 种 方法 。 针 对 工业 机 器 
人 数控 加 工 过 程 中 最 常用 的 直线 轨迹 规划 ， 进 行 了 简单 直线 插 补 和 五 次 样 条 曲线 插 补 两 种 轨 
迹 规划 算法 的 设计 。 

(2) 直线 插 补 算法 ”直线 插 补 通过 给 定 空间 直线 始末 两 点 的 位 姿 ， 按 照 线性 函数 变化 规 
律 求 轨 迹 中 间 点 〈( 插 补 点 ) 的 位 姿 。 使 用 直线 搬 补 时 ， 机 械 臂 的 姿态 变化 按照 给 定 的 步 长 
匀速 从 初始 位 姿 向 终 末 姿态 均匀 变化 。 

进行 直线 轨迹 的 定 步 长 插 补 的 算法 设计 过 程 为 : 

1) 输入 给 定 治 直线 始末 点 坐标 人 2，，2) 和 (x,，y,，z,)， 沿 直线 运动 的 运动 速 度 v 和 插 
补 周 期 《此 处 以 时 间 为 控制 量 )。 

2) 计算 始末 点 之 间 的 空间 距离 L 


大 OO 《6-83 ) 


TL (6-84) 

























































































3) 计算 运动 总 时 间 7T 


4) 计算 插 补 点 数 N 
N=fix (T/T +0.99) (6-85) 


其 中 ，fix0 为 回 零 取 整 函数 ， 根 据 精 度 要 求 选择 小 数位 的 进位 闵 值 ， 本 算法 精度 为 
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0.01mm， 因 此 进位 国 值 选择 0.99。 在 不 元 虑 伺服 机 构 执 行 死 区 大 小 的 情况 下 ， 插 人 补 炊 数 反 映 
了 直线 的 精度 ， 一 般 来 说 搬 补 次 数 起 多 ， 机 械 辟 的 轨迹 越 接近 直线 ， 但 是 随 看 插 补 次 数 的 增 
多 ， 控 制 系统 计算 的 时 间 成 本 也 将 增加 。 

5) 计算 插 补 增 量 dx，dy，dz 





dx = (xz —Xx)/N 
dy =( — yy)/N (6-86) 
dz =(z, —2Z)/N 
插 补 增 量 dx，dy，dz 肥 应 了 华 卡 尔 系 下 x，y，z 三 个 运动 宙 位 置 /时 间 平 面 中 的 轨迹 冬训 。 
6) 计算 各 得 补 点 的 绝对 位 置 





Xx, = Xl 十 11dx 
y, = +ndy (6-87) 
z, = 2 +ndz 
趟 中 na D2 Ns 
全 此 ， 直 线 插 补 过 程 完 成 
如 采 换 用 插 补 步 长 为 控制 量 的 插 补 方式 ， 会 略 有 改变 ， 基 本 遵循 位 置 伺服 的 PVT 控制 原 
则 。 计 算 过 程 与 以 时 间 为 控制 量 的 插 补 方式 基本 相同 。 在 此 给 出 一 种 以 插 补 步 长 为 控制 量 的 
实时 等 距 插 补 算法 ， 算 法 流程 图 如 图 6-22 所 示 。 


输入 当前 点 坐标 4 (7) 
po 算法 初始 化 上 一 点 坐标 4 (i 一 1) 
插 补 步 长 dt 
距离 计算 : L=|4 ( -4 (i-1) | 


点 数 计算 : N=L/dt 

















计算 各 轴 增 量 分 量 
dx=A(i)x—A(i—1)x 
dy=A(i)y-A(i-Dy 
dz=A (i )—A (1—1)z 





Y 
计算 各 轴 当 前 位 置 
X=A(iDDxti*dx 
=ACG)yti*dy 
Z=A(i)zti*dz 





等 间距 插 补 结束 


图 6-22 ”以 插 补 步 长 为 控制 量 的 实时 等 距 插 补 算法 流程 图 
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本 系统 最 终 使 用 图 6-22 所 示 的 直线 插 补 实现 方式 。 

(3) 五 次 样 条 曲线 插 补 算法 ”和 直线 插 补 虽然 在 计算 上 简单 易 行 ， 但 是 对 于 工业 机 械 芒 运 
行 的 一 些 关 键 性 参数 并 没有 考虑 ， 主 要 体现 在 对 于 速度 轨迹 和 加 速度 轨迹 并 没有 进行 规划 。 
其 结束 就 是 阶 跃 速度 和 和 宪 脉 冲 加 速度 输入 对 于 伺服 机 构 的 实际 啊 应 情况 影响 非常 不 利 ， 因 此 
在 轨迹 衔接 处 无 法 你 证 民 好 的 精度 (其 体 实验 结果 请 参见 运动 算法 实验 革 市 )。 因 此 需要 一 种 
有 具有 良好 数学 分 析 性 质 的 插 补 算法 ， 使 其 具有 三 阶 以 上 的 解析 结构 ， 保 证 二 阶 以 上 的 连续 与 
导数 连续 性 质 。 为 此 ， 引 入 一 种 五 次 样 条 曲线 插 补 复 法 ， 该 复 法 使 用 一 个 以 时 间 为 变量 的 五 
次 构造 多 项 式 描 述 笛 卡 儿 坐 标 空 间 的 末 态 位 置 ， 多 项 式 的 系数 通过 初 位 置 p,。、 末 位 置 p,、 初 
速度 dp 、 末 速度 dp,， 并 引入 抛 点 处 零 冲 量 假设 解 得 。 算 法 设计 过 程 如 下 : 

1) 输入 给 定 直线 始末 点 p=[%，y，z|]、 始 末 点 速度 dp,。、dp, 和 插 补 时 间 了 。 

2) 搬 补 时 间 归 一 化 1/7。 

3) 构造 五 次 多 项 陈 。 



































p= At* +Bt’ +Crt + Dt +Et+F (6-88) 
4) 求解 多 项 式 系 数 。 
对 式 (6-88) 求 导 和 求 二 阶 导 可 得 
万 =(S4 太 +4B +3Ct” +4Dt+E)/T (6-89) 





b=(204At +12Bt” + 6Ct +4D)/T’ (6-90) 


将 ps,，p,，dp,，dp,， 以 及 根据 抛 点 零 冲 量 假 设 得 到 的 声 = p=0 代 入 式 (6-87)、 式 
(6-88) 和 式 (6-89) 得 








Po = 了 

p=A+B+C+D+E 
dpo = E/T 

dp, =(SA+4B+3C+4D+E)/T 
b=0=4D/T 
b=0=(204+12B+6C+4D)/T° 


(6-91) 


祝 
da 


A =6(p,—p})-3dp, +dp,) 了 
B =-15(p,—p)+(8dp, +7dp,) 了 
C =10(p,— po)—(6dps +4dp,) 了 
D=0 
EF =dp,x7 
fF =po 
针对 具体 的 算法 实现 ， 时 间 了 可 以 通过 不 同 的 形式 给 出 ， 当 直接 以 时 间 形 式 给 出 时 ， 可 
以 直接 计算 插 补 点 ， 当 以 时 间 回 量 形 式 给 出 时 ， 取 出 时 间 癌 量 的 最 大 值 进行 归 一 化 ， 归 一 化 
后 得 到 有 时 间 量 纲 的 表达 式 ， 可 以 特 接 通 过 离 艇 的 时 间 回 量 对 应 值 获得 对 应 搬 补 点 。 当 以 定 
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(6-92) 
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扩 搬 促 ， 以 插 补 点 数 入 给 出 时 ,通过 归 一 化 后 可 得 到 无 量 岗 表达 式 ， 对 1 代入 对 应 点 数 可 得 到 
对 应 的 插 补 把。 全 此 五 次 样 条 曲线 插 补 过 程 完成 

对 应 空间 和 耻 线 轨 迹 的 插 补 算法 其 输入 量 p。，p,，dp。，dp, 部 是 三 维 同 量 。 分 别 独 立 计 算 
互补 济 合 。 因 此 ， 对 于 主动 目 由 度 之 间 不 相互 烙 合 的 机 械 避 ,该 算法 同样 且 接 适用 于 关 市 空 
间 。 直 接 用 六 维 的 9,，94,，d4qo。，dg, 进行 计算 ， 即 可 得 到 关节 空间 下 的 五 次 样 条 曲线 插 补 点 ， 
算法 本 身 不 需 做 更 改 。 

3. 目 适 应 力 答 控制 算法 设计 与 实现 

目 适应 力 和 窍 控 制 机 构 部 分 的 分 析 如 目 适 应 力矩 控制 结构 一 节 中 所 述 。 针 对 这 一 机 构 ， 分 
别 设 计 了 裔 力 平 衡 目 适应 筑 法 和 闭环 动力 控制 日 适应 算法 。 

(1) 角力 平衡 日 适应 算法 设计 _ 杆 件 质心 位 置 固 定 ， 根 据 机 械 结构 设计 分 机 ， 可 近似 假 
设 质心 居于 几何 中 点 ， 末 端 执 行 句 相对 于 关 记 轴 5 力 臂 较 短 ， 可 将 末端 执行 句 质 量 近 似 等 效 
到 关节 轴 5 处 ， 评 力 平衡 便 化 模型 如 图 6-23 所 示 。 
































图 6-23 ” 静 力 平衡 徐 化 模型 
建立 以 关 币 轴 2 为 轴 心 的 静 力 平衡 方程 : 


] 
MgL, cos0 + Eb cos0, 


(6-93) 


1 | . 
= ei cos ts(L, ws ng Jeos + Msg(L, Ey sin O, )cosb 


式 中 ， 世 为 连 杆 1 前端 长 度 ，Mi 为 其 质量 ;Ls 为 连 杆 1 后 背 长 度 ，W 为 其 质量 ; 工 ， 
为 连 杆 2 长 度 ，M; 为 其 质量 ; M; 为 末 妆 执行 融 质 量 ; 以 ,为 平衡 锤 质 量 ， 工 ,为 平衡 锤 质心 
到 转轴 的 长 度 。 

陈 〈6-93) 变形 整理 后 ， 得 到 以 4 、 多 为 输入 ， 平 衡 锤 位 置 忆 为 输出 的 毅力 控制 方程 : 














BA A tM J cos0, + [3% A sinQ cosl, -MD cOSZ (6-94) 
ee 
M cosO 
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由 于 结构 限制 和 总 的 转动 惯量 因素 考虑 ， 实 际 的 静 力 控制 很 难 做 到 驱动 单元 零 载 何 ， 对 
于 上 , 的 输出 需要 加 上 行程 限 幅 。 

(2) 闭环 动力 控制 日 适应 算法 设计 毅力 平衡 属于 对 于 重力 矩 的 简单 规划 ， 而 对 于 实际 
工作 过 程 中 加 减速 过 程 中 的 惯量 矩 没 有 考虑 。 因 此 对 于 实际 控制 ， 需 要 一 种 能 够 针对 关节 张 
动 单元 当前 负载 实时 进行 力矩 补偿 的 算法 。 

通 钊 进行 力矩 反 饶 的 方式 有 两 种 : 

1) 在 驱动 天 广 的 输出 轴 串 联 应 变 式 力 传 感 右 。 

2) 通过 伺服 电动 机 的 电流 变化 ， 间 接 有 反映 力矩 变化 。 

对 于 低 成 本 的 小 型 操作 臂 ， 本 项 目 设计 的 操作 臂 并 没有 使 用 独立 的 力 算 检测 机 构 和 传 感 
器 。 设 计 使 用 的 驱动 单元 “Dynamixel RX24F” 骨 机 具有 通过 电流 环 进行 无 量 纲 的 力矩 控制 的 
能 力 。 通 过 反馈 比较 即 可 实现 动力 的 团 环 控 制 ， 具 体 PID 控制 算法 如 图 6-24 所 示 。 


,> 

















人 
9 一 十 之 -加 本 
了 
To 微分 器 


fs 
图 6-24 闭环 动力 PID 控制 算法 
该 方式 使 用 PID 控制 器 实现 反馈 控制 ， 图 6-24 中 PID 参数 Kh，T， 克 分 别 为 比例 增益 ， 
积分 增益 和 微分 增益 系数 。 反 馈 量 纲 匹 配 增益 系数 为 大， 网 中 各 系数 均 未 经 过 整定 ， 需 要 结合 
实物 平台 进行 参数 整定 ， 获 得 最 终结 末 。 


6.3.4 上 位 机 软件 设计 


1. 算法 仿真 环境 

算法 仿真 环境 主要 逢 要 实现 以 下 功能 : 

1) 前 期 运 控 算法 编写 。 

2) 运 控 算 法 结果 校 验 。 

3) 可 视 化 仿真 。 

4) 实验 评 佑 。 

针对 以 上 功能 需要 ， 结 合 机 械 臂 运动 学 研究 中 对 矢量 、 算 阵 运算 的 大 量 需求 ， 决 定 上 位 
机 系统 以 MATLAB 为 核心 进行 开发 ， 使 用 功能 强大 的 MATLAB 机 器 人 学 工具 箱 (Robotics 
Toolbox for MATLAB) 辅助 完成 工作 。MATLAB 机 器 人 学 工具 箱 是 由 澳大利亚 Pinjarra Hills 
联邦 科学 与 工业 研究 组 织 的 Peter I.Corke 编号 的 开源 工具 箱 。 该 工具 箱 提供 了 大 量 在 机 器 人 学 
研究 中 起 到 重要 作用 的 函数 ， 如 运动 学 、 动 力学 和 轨迹 规划 等 方面 的 函数 。 该 工具 箱 可 以 较 
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好 地 满足 研究 人 员 对 机 器 人 实体 的 仿真 与 实验 结果 分 析 的 需求 。 

该 工具 箱 从 方法 上 对 串联 结构 机 械 臂 的 运动 学 与 动力 学 研究 进行 了 一 般 性 的 定义 。 通 过 
刚体 杆 件 的 DH 参数 模型 建立 , 即 可 完成 从 运动 学 、 动 力学 计算 到 模型 可 视 化 的 全 部 机 堪 人 研 
究 过 程 。 该 工具 箱 内 还 包含 了 大 量 典 型 的 工业 机 絮 人 模型 实例 ， 如 Puma560、Stanford Arm、 
Fanucl0L 等 。 除 此 之 外 ， 该 工具 箱 还 提供 了 回 量 、 齐 次 变换 阵 与 单位 四 元 数 等 用 于 摘 述 机 械 
臂 在 三 维 空间 中 位 次 的 操作 与 变换 函数 ， 这 为 机 峰 人 学 中 运动 学 与 动力 学 中 的 具体 运算 提供 
了 数学 工具 层面 的 便利 性 。 

同时 利用 MATLAB 交互 性 好 和 易于 处 理 数据 生成 图 表 的 特点 ， 通 过 MATLAB 在 上 位 机 
中 建立 了 仿真 环境 ， 有 基体 包 括 可 视 化 界面 和 评估 系统 。 

可 视 化 界面 通过 调用 Robotics Toolbox 中 重 定 同 的 plot 函数 实现 ， 以 杆 件 模 型 的 形式 可 视 
化 地 表示 出 机 械 臂 的 关 和 和 杆 件 信息 。 有 基体 效果 如 网 6-25 所 示 。 该 函数 既 可 以 用 于 静态 显示 
东 一 特定 正 运 动 学 位 形 ， 也 可 以 通过 和 矩阵 的 形 陈 输入 二 维 的 关 贡 空间 控制 矢量 4， 以 动画 形式 
反映 机 械 臂 的 运动 过 程 。 















































图 6-25 可视化 界面 实际 效 末 
评估 系统 通过 将 各 种 控制 参数 信息 以 图 形 的 形式 下 观 显 示 ， 反 映 挥 制 效 未 ， 图 6-26 所 示 
为 天 节 角 位 置 曲线 评估 系统 效果 。 图 6-27 所 示 为 校 微 思 路 实际 运行 仿真 。 
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图 6-26 关 广 角 位 置 曲线 评 信 系统 效果 
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图 6-27 ”校徽 刀 路 实际 运行 仿真 


2. 交互 式 仿真 实验 系统 及 评估 系统 

科学 可 视 化 、 计 算 机 仿真 和 虚拟 现实 是 近年 来 计算 机 仿真 领域 的 三 大 热门 技术 ， 而 这 三 
大 热门 技术 的 核心 均 是 三 维 真 实感 图 形 的 显示 与 交互 。 其 中 机 器 人 三 维 运动 仿真 技术 在 机 器 
人 的 研究 与 应 用 中 发 挥 着 重要 的 作用 。 机 械 臂 三 维 运 动 仿 真是 机 器 人 仿真 研究 中 一 个 很 重要 
的 组 成 部 分 。 对 于 本 项 目 研 究 的 新 型 焊接 工业 机 械 臂 而 言 ， 利 用 三 维 运动 仿真 技术 对 机 械 辟 
的 运 控 算 法 进行 检验 ， 甚 至 对 机 械 臂 的 加 工 轨迹 进行 规划 和 对 加 工 过 程 进行 干涉 检验 ， 可 以 
把 对 机 械 臂 的 示 教 过 程 转移 到 虚拟 测试 平台 中 ， 从 而 科学 有 效 地 模拟 机 器 人 的 动态 特性 ， 验 
证 机 器 人 的 工作 原理 和 工作 空间 ， 还 可 以 避免 因 现 实 中 的 错误 操作 而 给 机 械 臂 带 来 无 法 挽回 
的 损失 。 因 此 ， 充 分 利用 机 堪 人 三 维 运动 仿真 技术 在 是 实用 化 离线 编程 技术 的 重要 部 分 。 

机 械 辟 仿真 有 各 种 方式 ， 比 如 可 以 用 MATLAB、ADAMS 等 这 些 平台 进行 运动 仿真 ， 都 
能 达到 一 定 的 效果 。 如 今 在 机 器 人 运动 学 方面 ， 尤 其 是 对 多 关节 结构 的 机 械 臂 的 运动 学 的 研 
究 己 经 比较 深入 成 熟 ， 己 经 有 从 事 相 关 人 研究 的 研究 人 员 开 发 了 在 MATLAB 平台 下 ， 能 够 通过 
函数 实现 简单 的 运动 学 仿真 的 机 器 人 运动 学 工具 箱 。 如 果 基 于 MATLAB 开发 平台 的 ， 想 在 机 
械 辟 仿真 平台 上 扩展 些 狐 功 能 不 如 在 VC 平台 上 方便 ， 而 且 显示 效果 并 不 是 很 好 。 目 前 ， 
OpenGL 是 较 实 用 的 开发 机 堪 人 图 形 仿真 系统 工具 。OpenGL 〈 即 开放 性 图 形 库 Open Graphics 
Library) 是 一 种 与 硬件、 窗口 系统 和 操作 系统 相 独 立 的 一 系列 应 用 程序 接口 (API) 运 用 OpenGL 
开发 人 员 可 方便 绘制 出 客观 世界 逼真 的 三 维 景象 。OpenGL 已 广泛 应 用 于 可 视 化 技术 、 实 体 造 
型 、CADMCAM、 模 拟 仿真 等 诸多 领域 。 绽 合 考虑 ， 本 项 目 采 用 在 VC++6.0 开发 平台 上 ， 基 于 
MFC 框架 类 和 OpenGL 的 函数 库 来 开发 仿真 软件 。 

(1) 仿真 方案 的 确定 ”进行 机 器 人 仿真 的 三 维 实体 建 模 工作 方案 一 般 有 : 外 使 用 VRML 
和 Java3D 在 一 般 的 微机 上 构造 轻 量 级 的 仿真 平台 ， 可 应 用 于 网 络 功 能 要 求 较 高 的 机 器 人 运动 
仿真 。VRML 和 Java3D 的 路 平台 性 、 网 络 化 和 强大 的 可 编程 能 力 ， 对 于 实现 网 络 化 机 器 人 仿 
真 不 失 为 一 种 简单 、 廉 价 而 有 效 的 手段 。 凶 使 用 虚拟 样机 技术 。 通 过 在 Pro/E 或 其 他 三 维 环境 
下 建立 的 机 器 人 三 维 模型 和 在 ADAMS 环境 下 建立 的 力学 模型 对 机 器 人 进行 仿真 研究 。 主 要 
应 用 于 检验 机 器 人 各 部 件 的 设计 性 能 及 部 件 之 间 的 兼容 性 ， 并 检查 整 机 的 综合 设计 性 能 ， 实 
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现 高 质量 、 快 速 、 低 成 本 的 设计 。 图 在 Windows 环境 下 ， 配 合 某 些 三 维 建 模 工 具 如 
AutodeskInventor 或 3DMax 等 ， 使 用 VisualC++ 工 具 调 用 OpenGL 图 形 库 中 的 函数 ， 实 现 三 维 
运动 仿真 。 目 前 ，Microsoft、SGI、IBM 等 大 公司 都 采用 了 OpenGL 作为 三 维 图 形 标 准 。 特 别 
是 随 看 PC 性 能 的 不 断 提 升 和 微软 的 加 入 , 使 得 在 微机 上 实现 三 维 真 实感 图 形 的 显示 与 交互 成 
为 可 能 ， 也 为 广大 用 户 提 供 了 在 微机 上 使 用 以 前 只 能 在 高 性 能 图 形 工 作 站 上 运行 各 种 软件 的 
机 会 。 另 外 ， 由 于 系统 中 涉及 较 多 的 机 械 臂 正 、 逆 运动 学 方程 求解 问题 ， 因 而 采用 VC 作为 编 
程 语言 ， 一 方面 可 以 方便 地 调用 OpenGL 图 形 库 函 数 ， 另 一 方面 有 利于 算法 的 实现 。 

(2) 仿真 实体 的 绘制 在 本 系统 中 ， 三 维 实体 的 绘制 采用 了 以 下 方法 来 实现 : 

1) 对 于 结构 比较 复杂 而 控制 要 求 简单 的 工作 对 象 或 者 其 他 附件 ， 使 用 OpenGL 直接 绘制 是 

件 十 分 烦琐 的 工作 。 而 3DMax 是 一 个 相当 好 的 流行 建 模 工 具 , 通过 对 简单 几何 形体 进行 并 、 交 、 

切 等 布尔 运算 和 曲面 编辑 等 功能 就 能 构造 出 复杂 的 儿 何 形体 。 在 完成 复 森 的 建 模 后 ， 输 出 3DS 格 
式 文件 ， 再 通过 一 些 相 关 工 具 软 件 (如 VIEW3DS) 可 以 生成 *.gl] 与 *h 格式 的 数据 文件 ， 直 接 导 
入 到 VC 工程 中 ， 稍 加 修改 就 可 完成 复杂 模型 的 绘制 工作 。 网 6-28 所 示 为 单 件 模 型 仿真 效果 。 
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图 6-28 ” 单 件 模型 仿 丰 效果 


2) 对 于 结构 从 单 而 控制 要 求 较 复杂 的 机 械 辟 各 轴 ， 可 直接 使 用 OpenGL 提供 的 三 维 建 模 
函数 完成 绘制 。 在 此 过 程 中 ， 对 各 轴 的 缩放 、 位 置 、 角 上 度 的 调整 主要 使 用 函数 glScalef ()、 
glTranslatef() 和 glRotatef( ) 来 完成 ， 并 且 在 程序 中 采用 了 花 套 结构 ， 使 得 机 械 臂 的 每 个 部 
件 都 是 在 前 一 个 部 件 的 相对 坐标 下 完成 绘制 ， 这 样 可 以 保证 组 成 机 械 辟 的 某 一 部 件 在 空间 姿 
态 有 所 改变 时 ， 在 其 后 顺序 联接 的 每 个 部 分 相对 该 部 件 的 姿态 不 变 ， 而 相对 于 空间 坐标 系 发 
生 与 该 部 件 同 样 的 姿态 改变 。 这 就 保证 了 机 械 辟 部 件 在 OpenGL 中 保持 相对 独立 性 的 同时 依 
然 在 部 件 与 部 件 之 则 保持 相互 联系 。 如 以 下 例 程 所 示 : 

/ 腻 关 节 --$ 

glPushMatrix(); 


{ 
glTranslatef(150.0f， 0.0f， 0.0D; V 在 导入 胸 关 节 模 型 之 前 调整 OpenGL 中 的 坐标 系 
glRotatef(-90.0f, 0.0f, 0.0f, 1.0f); 
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glRotatef(180.0f, 0.0f, 1.0f, 0.0f); 

glRotatef(15.0f, 0.0f, 0.0f, 1.0f); 

glRotatef((GLfloat)(-theta5)， 0.0f， 0.0f， 1.0f);//theta5 值 为 MATLAB 道 运动 学 求解 所 得 腕 关节 旋 
转角 

glCallList(link 9); /导入 腕 关节 模型 

/ 末 闹 执行 莫 --6 

glPush Matrix(); 

{ 





glTranslatef(20.0f, 69.8f, 0.0f); 
glRotatef(90.0f, 1.0f, 0.0f, 0.0f); 
glRotatef(180.0f, 0.0f, 0.0f, 1.0f); 

glRotatef((GLfloat)(-theta6)， 0.0f， 0.0f， 1.0D; Wtheta6 值 为 MATLAB 逆 运 动 学 求解 所 得 末端 执行 器 
旋转 角 

glCallList(link 6); 
} 
glPopMatrix(); 

) 

glPopMatrix(); 

为 使 绘制 出 来 的 各 轴 形 象 帝 真 ， 可 对 各 轴 进 行 相应 的 材质 、 光 照 设置 ， 在 轴 之 间 进 行 装 
配 时 , 需要 使 用 和 矩阵 堆栈 来 保证 预 留 对 各 轴 控 制 接 口 的 正确 性 , 其 函数 原型 是 glPushMatrix () 
和 glPopMatrix()， 为 外 ， 这 里 所 介绍 的 机 械 辟 属于 双 站 协调 工作 方式 ， 所 以 准 配 还 受到 工作 
模式 的 动态 控制 ;为 使 仿真 显示 的 图 形变 化 连续 ， 一 般 使 用 OpenGL 提供 的 缓存 交换 函数 
auxSwapBuffers () 来 实现 双 绥 存 绘制 。 

VC6.0 人 机 交互 界面 与 MATLAB 运 控 程序 通信 问题 : 

首先 , 人 机 界面 与 MATLAB 运 控 程序 之 间 的 通信 方式 采用 串口 通信 方式 。 借助 MATLAB 
强大 的 算 阵 运算 功能 ， 通 过 CAM 软件 把 茶 一 图 形 的 轮廓 生成 为 NC 思路 图 ， 结合 定 距 插 补 算 
法 生成 一 段 G 代码 运 控 程 序 ,以 G 代码 中 机 械 臂 末 闪 执行 名 轨迹 氮 坐 标 为 逆 运 动 学 已 知 数据 ， 
在 MATLAB 环境 下 进行 逆 运 动 学 求解 运算 。 求解 所 得 机 械 辟 各 关节 旋转 角度 以 二 进 制 方式 通 
过 串口 〈 目 前 调试 使 用 虚拟 串口 ) 从 MATLAB 求解 器 发 送 到 人 机 界面 。OpenGL 在 接收 到 串 
口 发 来 的 指令 时 ， 和 触发 OnThetaTransmit () 函数 ， 对 指令 进行 译 码 ， 从 指令 中 提取 关节 旋转 
角 值 并 将 它们 相应 地 赋予 OpenGL 中 控制 每 个 关节 旋转 角 的 6 个 变量 (thetal ，theta2，theta3， 
theta4，theta5，theta6 )。 每 接受 一 条 指令 束 翻 详 一 条 指令 ，, 并 进行 相应 的 天 广 旋 转角 值 的 传递 ， 
这 样 就 能 实现 MATLAB 求解 与 OpenGL 环境 中 机 械 臂 运动 的 同步 。 串 口 发 来 的 指令 以 2 个 各 
占 一 个 字 节 的 FF 开头 ， 接 下 来 的 12 个 字 节 用 来 描述 机 械 臂 6 个 关节 的 关节 旋转 角度 ， 总 共 
14 个 罕 节 。 除 了 指令 头 ， 余 下 的 每 2 个 宇 市 表示 一 个 关节 的 旋转 角 ， 分 别 以 高 8 位 《前 一 个 
7 

一 般 来 说 ， 详 人 码 的 过 程 要 求 融 效 可 徘 。 噩 效 性 主要 由 程序 的 运算 速度 决定 。 而 对 于 任何 
一 种 语言 的 编程 来 说 ， 移 位 与 滥 辑 运算 速度 远 遍 于 乘除 法 运算 ， 所 以 详 但 的 高 效 性 在 本 程序 
中 主要 由 移 位 逻辑 运算 保证 。 而 可 靠 性 主要 由 准确 捕捉 指令 头 “FF FF” 决 定 。 

详 但 代码 如 以 下 所 未 : 
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for (i=0;i<len;i 寺 +) ” /len 为 所 接收 到 串口 数据 的 长 度 
让 (rxdatali]!='FF") // 串口 发 来 的 指令 以 2 个 各 占 一 个 字 节 的 FE 为 指令 头 
//long 型 数组 theta[6] 用 于 和 暂 存 转换 后 的 关节 旋转 角 
theta[0] = ((rxdata[1|<<8)l(rxdata[i+1|))/10; 
theta[1| = ((rxdata[l1+2]<<8)l(rxdata[1+3]))/10; 
theta[2] = ((rxdata[l1+4]<<8)l(rxdata[1+5]))/10; 
theta[3] = ((rxdata[l1+6]<<8)l(rxdata[1+7|]))/10; 
theta[4| = ((rxdata[1+8]<<8)l(rxdata[1+9]))/10; 
theta[3] = ((rxdata[li+10]<<8)l(rxdata[1+11]))/10; 
break: 


else 


continue; 


thetal=theta[0]; // 完成 指令 详 码 后 ， 对 关节 旋转 角 变 量 进行 赋值 
theta2=thetal ] ]; 

theta3=theta[2]; 

theta4=thetal[3]; 

thetaS=thetal[4|; 

theta6=thetal 3 ]; 

交互 式 仿真 系统 实际 仿真 效 末 如 图 6-29 所 示 。 


ER -— 





























图 6-29 交 扭 式 仿真 系 给 充实 际 仿真 效果 





3. 接口 软件 设计 
在 执行 具体 的 指令 时 ， 指 令 层 级 接口 如 图 6-30 所 示 。 
接口 软件 设计 部 分 主要 包含 : NC 代码 详 人 码 接口 、 笛 卡尔 空间 指令 接口 、 轴 驱动 详 人 码 接口 ， 


@ 
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以 及 用 于 压 层 伺服 控制 的 RS485 数据 接口 。 


J 箭 卡尔 空间 嵌入 式 控制 系统 ， 
0 指令 接口 a 
: | 


U 





| 帮 路 图 NC 代 码 译 码 接口 一 | = 入 位 掉 条 驱 动 译 码 接口 RS485 数 据 接口 一 >| 执行 机 构 
人 人 
| 
ee ne 
笛 卡 尔 空间 
指令 接口 


轴 了 驱动 译 码 接口 





图 6-30 ”指令 层级 接口 

(1) NC 代码 译 码 接口 “作为 与 现 有 工业 标准 兼容 的 数控 加 工 设 备 ,“ 新 型 机 械 臂 ” 首 
和 完 需 要 兼容 现 有 的 NC 代码 控制 指令 。NC 代 人 码 束 是 数学 信息 控制 机 械 控制 右 能 识别 的 代 
码 ， 例 如 数控 切割 设备 上 就 有 G 人 代码、ESSI 码 、EIA 人 码 等 。 本 控制 系统 主要 使 用 G 代码， 
G 代码 是 一 种 在 计算 机 数控 机 床 CCNC) 中 应 用 最 为 广泛 的 目 动 编程 语言 ， 是 计算 机 辅助 
工程 CCAE) 的 重要 组 成 部 分 。 作 为 一 种 ISO 标准 广泛 应 用 于 各 种 数控 机 床 中 的 G 代码 ， 
它 将 图 纸 中 工件 的 点 、 线 、 面 的 信息 提取 为 加 工 工具 的 运动 路 径 。 这 了 驶 大 大 简化 了 将 其 转 
换 为 机 器 人 加 工 指 令 的 难度 ， 并 且 几 乎 所 有 的 大 型 CAD/CAM 制图 软件 ， 如 UG、Pro/E、 
MasterCAM 及 AutoCAD 都 可 以 直接 生成 G 代码 文件 。 本 项 目 控制 系统 软件 指令 沉 如 图 
6-31 所 示 。 























运动 学 逆 解 
Ey 


译 码 
/ Wik 7 As 
特征 信 
硬件 驱动 输出 
轨迹 规划 
1 / 0 驱动 信号 






插 补 点 坐标 值 、 
速度 值 、 加 速度 值 





图 6-31 控制 系统 软件 指令 流 图 
对 于 执行 NC 代码 来 说 ， 最 关键 的 软件 接口 为 NC 代码 的 译 码 接口 。NC 代码 的 保存 形式 
为 标准 ASCII 但 文本 形式 。 所 以 利用 字符 栈 扫 摘 方式 进行 译 码 ， 详 但 接口 的 算法 流程 图 如 图 
6-32 所 示 。 
通过 本 算法 ， 以 ASCI 码 形式 存储 的 NC 代码 ， 经 过 译 公 你 存在 二 维 数 组 NC_data 中 ， 
NC data 的 奇数 行 用 于 以 ASCII 码 的 形式 存储 具体 的 NC 代码 指令 类 型 , 偶数 行 双 精 度 浮 点 数 
的 形式 存储 上 一 行 对 应 位 置 的 数据 值 。 例 如 表 6-2 中 所 示 的 G 代码 与 其 输出 结果 。 


@ 
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表 6-2 6 代码 与 其 输出 结果 


索引 代码 类 型 Z 位 置 
G 代码 N60 GO0 Z65.000 
入 出 行 21 7 
该 接口 在 上 位 机 与 散 入 式 系 统 均 有 涉及 ， 所 以 使 用 C 语言 编写 ， 在 MATLAB 中 使 用 m 
脚本 内 藤 C 的 方式 实现 ， 有 具体 为 先 将 C 语言 源 程序 添加 MATLAB 工作 衬 间 接口 后 编译 为 
mexw32 动态 链接 库 ， 然 后 在 m 脚本 中 和 直接 调用 动态 库 实现 算 法 功能 。 通 过 这 种 方式 ， 在 保 
证 各 部 分 功能 均 可 实现 的 情况 下 ， 提 高 了 算法 的 可 移植 性 。 


获取 代码 行 数 N 输入 *. NC 文件 


定义 
算法 初始 化 


NC data[N][lim]: 
a 
Y 


读 取 *. NC 第 i 行 ; j=1 

















AAA 





该 取 *. NC 第 i 行 第 j 字 符 


Y a N 
字母? 
ASCII 码 双 精 度 浮 点 
存 于 数组 存 于 数组 
NC data[2*i-1][j] NC_data[2*1][]] 
j++ 

i=i+2 
输出 数组 


NC data[2*N] [lim|] 


G 代 码 转 译 结束 
图 6-32 ”NC 代码 译 码 接口 的 算法 流程 网 
(2) 上 下 位 机 角 位 置 指令 接口 上 下 位 机 角 位 置 指 令 接 口 的 功能 为 将 上 位 机 的 角 位 置 指 


@ 


第 6 章 ”新 型 工业 焊接 机 械 辟 








令 与 图 6-30 中 所 示 的 轴 驱 动 译 人 码 接口 进行 匹配 的 软件 接口 。 上 位 机 算法 仿真 系统 中 的 角 位 置 
指令 ， 通 过 本 软件 接口 ， 将 关 市 空间 矢量 对 应 的 各 轴 角 位 置 值 发 送 给 舱 入 式 控制 系统 的 轴 驱 
动 模块 。 接 口 的 链 路 层 协议 使 用 USART 串 行 协议 ， 物 理 层 使 用 RS-232 串 行 通信 接口 。 因 此 
在 指令 帧 设计 上 参考 了 Robotics Dynamixel 数据 协议 。 

上 下 位 机 通信 和 角 位 置 指令 帧 格式 见 表 6-3。 








表 6-3 -一 一 一 一 


mm 
喷头 一 校 验 位 
es 





指令 
OxFF OxFF 0xXX 0xXX 0xXX 0xXX 0xXX 0xXX 0xXX 
列队 


其 中 ， 帧 头 与 校 验 和 的 定义 与 Robotics Dynamixel 数据 协议 相同 ， 不 再 车 述 。 有 效 的 数据 
学 节 包 括 针 对 “ 狐 型 机 械 臂 ”7 个 目 由 上 度 的 控制 指令 。 因 为 RX24F 骨 机 的 角 位 置 反 馈 为 10 位 
A/D 精度 采样 的 精密 电位 吉 ， oo 在 PC 交友 送 本 ， 将 角 位 置 经 过 量 
纲 变换 取 整 后 拆 分 为 事 、 低 学 三。 以 0 为 例 的 MATLAB 代码 实现 : 


























a = q*614.4/pi; re 广 空 间 控制 器 量 gq 进行 量 纲 转换 
b = round(a); % 对 a 进行 取 整 
0 0 % 对 0 进行 零点 偏 置 调整 
a2 = fix(A1/256): % 取 0 局 字 市 
al =rem(Al1, 256); % 取 0 低 学 市 


仍 入 式 系 统 接收 后 将 高 、 ee 16 位 整形 变量 (unsigned int 类 型 )。 最 终 
自信 队列 的 有 效 长 度 为 14 字 

(3) RS485 数据 接口 “3 了 型 机 械 句 ”设计 使 用 的 舵 机 RX-24F 使 用 Robotics Dynamixel 
专 有 格式 的 指令 帧 协议 。 

1) RS485 指令 帧 格式 见 表 6-4。 


表 6-4 RS485 指令 帧 格式 


字 头 | 数据 帧 长 指令 类 > 参 校 验 和 


OxFF OxFF 


A 义 如 下 : 

Q@ 帧 头 ， 连续 收 到 两 个 0XFF， 表 示 有 新 数据 包 到 达 。 

© ID: ee 机 都 有 一 个 ID 号 。ID 号 编码 范围 0 一 253, 转换 为 十 六 进 制 0X00~0XFD。 
ID 号 254 为 广播 DD， 蔡 控制 器 发 出 的 ID 号 为 234 (0XFE)， 所 有 的 艇 机 均 会 接收 到 此 指令 
和 令 ， 但 都 不 返回 应 答 信 息 。 

(3) 数据 长 度 : 等 于 待 发 送 的 参数 长 度 N 加 上 2， 即 “N+2”。 

(4) 参数 : 除 指令 外 需要 补充 的 控制 信息 。 

G@) 指令 : 共有 7 种 有 效 控制 指令 ， 分 别 为 : 

a. 查询 (0x01): 查询 工作 状态 。 

b. 读 (0x02): 查询 控制 表 里 的 数据 。 





OxXX 
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c， 写 (0x03): 问 控 制 表 内 写 入 数据 。 

d. 异步 写 (0x04): 类 似 于 “ 写 ” 指 令 ， 但 是 控制 数据 写 入 后 并 不 立即 执行 ， 而 是 直到 
“执行 ”指令 到 达 。 

e. 执行 (0x05): 与 “异步 写 ” 配 合 使 用 ， 触 发 “异步 写 ” 写 入 的 动作 。 

f. 复位 (0x06): 把 控制 表 复 位 为 出 广 值 默认 。 

g. 同 写 (0x83): 对 多 个 舵 机 的 相同 寄存 器 进行 连续 写 入 。 

@ 校 验 和 : 校 验 和 Check Sum， 计 算 方 法 如 下 。 

Check Sum = 一 (ID +N+2+I+ 参 数 1+... 参 数 N) 

数据 类 型 为 unsigned char， 不 考 碟 浇 ,“ 人 一 ”表示 C 语言 按 位 取 反 。 

2) 应 答 帧 的 帧 格式 与 指令 帧 基本 相同 ， 其 体格 式 见 表 6-5。 


表 6-5 RS485 应 答 帧 格式 


参数 1… 参 数 ~ J 


由 于 应 答 帧 的 帧 格式 其 他 参数 与 指令 帧 相同 ， 在 此 不 做 歼 述 ， 与 指令 帧 “指令 类 型 ” 字 
节 位 置 对 应 的 字 节 ， 在 应 答 帧 中 表示 当前 工作 状态 ， 该 字 节 各 个 数据 位 定义 如 下 : 

GD BIT7: 保留 。 

@ BIT6: 指令 错误 ， 如 果 收 到 一 个 未 定义 的 指令 或 收 到 “执行 ”前 未 收 到 “异步 写 ” 指 
令 置 1。 

@) BIT5: 过 载 ， 位 置 模式 运行 时 输出 扭矩 小 于 负载 置 1。 

由 BIT4: 校 验 和 错 校 验 和 错误 置 1。 

(5) BIT3: 指令 超 范 围 ， 指 令 超过 指定 范围 置 1。 

(6) BIT2: 过 热 ， 温 度 超过 指定 范围 置 1。 

CO BIT1: 角度 超 范围 ， 角 上 度 超过 设 定 范围 置 1。 

(8) BIT0: 过 压 灾 压 ， 电 压 超 过 指定 范围 置 1。 


6.3.5 ”运动 控制 算法 实验 

本 章 所 有 仿真 实验 均 在 6.3.4 节 “ 上 位 机 软件 设计 ”中 构建 的 可 视 化 界面 和 评估 系统 中 
实现 。 

1. 运动 学 逆 解 算法 仿真 

(1) 仿真 环境 准备 ”仿真 样本 为 以 齐 次 变换 矩阵 形式 给 出 的 直线 段 闪 点 : 
























































1 0 0 -100 1 0 0 100 
0 1 0 80 0 1 0 160 
0 0 1 -80 0 0 1 -40 
0 0 0 1 0 0 0 1 


机 械 臂 初始 位 姿 为 
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=[0-m3m3000] (6-96) 
以 齐 次 变换 阵型 是 给 出 为 
1 0 0 125.7 
010 50 
07(o) = (6-97 ) 
c 0900 0 1 701 
000 1 


此 时 的 机 械 臂 位 形 如 图 6-33 所 示 。 


PROTO-TYPE 


图 6-33 =[0-m3m3000] 下 的 机 械 臂 位 形 
使 用 每 间距 直线 插 补 算法 ， 插 补 点 距 4 = lmm ， 轨 迹 模 长 工 为 


L=|T -T=VG x) +Cy, —y0) +(z, — 20) =219.089 (6-98) 


实际 插 补 点 数 为 





fix (L/d+0.99)= 220 (6-99 ) 
仿真 路 径 中 各 关节 运动 位 置 曲线 如 网 6-34 所 示 ， 机 械 臂 执行 目标 轨迹 To-T, 的 过 程 如 图 
6-35 所 示 。 


关节 1/rad 

OO iD 下 
关节 2/rad 

| 

pa OO 


0 2 4 6 “0 2 4 6 
时 间 /s 时 间 /s 
x S 


关节 3/rad 
OO = 
CA -一 LA 
/ 
关节 4/rad 
© LA 


2 4 0 0 2 4 0 
时 间 /s 时 间 |/s 


” 


关节 5/rad 
一 = 
LA [aa LA 
CD 

\ 
关节 6/rad 
LL 下 


4 6 0 2 4 6 
时 间 /s 时 间 /s 


图 6-34 ”仿真 路 径 中 各 关节 运动 位 置 曲 线 
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PROTO-TYPE 








图 6-35 机械 臂 执 行 目 标 轨迹 To-T, 的 过 程 


仿真 实验 中 通过 MATLAB 程序 计时 函数 etime 和 clock 进行 算法 收敛 速度 和 效率 的 统计 。 
etime 和 clock 函数 的 使 用 方式 为 








t0 = clock: % 装 载 计 时 临时 变量 t0 
User code; % 此 处 插入 竺 计时 代码 


t=etime(clock, 10); % 获 取 计 时 值 t 

但 是 由 于 MATLAB 的 m 脚 本 语言 为 解释 型 程序 语言 , 在 执行 过 程 中 受 操作 系统 资源 复 用 、 
及 代码 解释 方式 的 影响 ， 会 在 算法 耗 时 上 受 一 定 的 随机 因素 影响 。 以 下 所 有 仿真 实验 数据 均 
通过 三 次 独立 执行 ， 然 后 取 平 均值 获得 ， 尺 量 避 免 在 解释 过 程 中 受到 的 随机 性 误差 影响 ， 以 
便 获 得 一 般 性 实验 结 

(2) 解析 法 求 逆 解 速度 仿真 ”通过 程序 计时 函数 对 单 次 解析 法 求 揽 解 的 过 程 进 行 计 时 ， 
代码 实现 方式 如 下 : 

















np = size(T, 3); % 取 插 补 点 数 
for i=1:np % 对 插 补 点 数 进行 循环 
t0=clock: 

q A=ikine A(p560, T(:,:, i)); % 解 析 法 求 逆 解 函 数 

if (q A(1，4)>pi2)J|(q A(L1，4)<-pi/2) % 球 及 翻转 条 件 
q=[9q;q_A(3, :)]; 
tcount = [tcount;etime(clock，t0)]; ”% 取 计时 结果 

else 
q=[q;q_A(1, :)}; 
tcount = [tcount;etime(clock，t0)]; ”% 取 计时 结果 

end 

end 





但 是 通过 该 种 计时 方式 得 到 的 结果 ， 矢 量 tcount 中 的 元 素 过 小 ， 无 法 辨识 ， 说 明 解 析 法 
过 


求 逆 解 速度 过 快 ， 超过 了 程序 计时 函数 etime 的 计时 分 辩 率 。 因 此 对 正解 求解 过 程 使 用 为 外 的 
La ee 


np = size(T, 3); % 取 插 补 点 数 
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tO=clock: 
for i=1:np % 对 插 补 点 数 进行 循环 

q A=ikine A(p560, T(:，:, i)); % 解 析 法 求 逆 解 函 数 

if (q A(l, 4)>pi/2)(q A(L1，4)<-pi/2) % 球 及 翻转 条 件 
q=[9q;q_A(3, :)]; 

else 
q=[q;q_A(1, :)}; 

end 

end 


tc=etime(clock, t0); 
该 方式 通过 对 220 次 逆 解 的 总 时 间 进 行 计 时 ， 得 到 计时 值 太 = 0.0732s (三 次 实验 数据 分 
别 为 ， 4 = 0.0732s ，t, = 0.0880s ，t = 0.0750s )。 由 此 可 得 出 ， 通 过 解析 法 求 逆 解 的 单 次 
执行 平均 时 间 为 : 





f=t./220=3.32x10™ (6-100) 


仿真 结果 表明 ， 对 于 MATLAB 平台 ， 解 析 法 求 逆 解 的 算法 执行 时 间 在 100ks 数量 级 。 

(3) 牛顿 -拉夫 逊 迭 代 法 效率 仿真 

1) 算 法 收敛 速度 实验 。 对 算法 执行 过 程 中 的 欠 代 次 数 进行 统计 得 到 在 对 应 收敛 误 兰 限 stol 
分 别 取 stol=10" mm 、stol=10-mm 、stol=10 ?mm 时 ， 各 个 插 补 点 的 迭代 次 数 NN 和 单 次 逆 
解 算法 耗 时 统计 表 见 表 6-6。 











表 6-6 ”牛顿 -拉夫 逊 迭 代 法 耗 时 统计 表 


et 后 续 挝 代 次 数 平均 耗 时 A 


由 表 6-6 中 数据 可 以 得 出 以 下 结论 : 

首先 ,通过 相差 两 个 以 上 数量 级 的 三 组 收敛 误差 限 stol 的 结果 对 比 , 算法 并 没有 因为 收敛 
误 兰 限 的 城 小 ,而 使 算法 复杂 度 和 时 间 开 销 线性 增加 ,迭代 次 数 和 时 间 开 销 与 收敛 误 兰 限 stol 
的 变化 基本 符合 指数 函数 关系 ， 实 现 了 议 计 预期 的 快速 收敛 。 

其 次 ， 在 迭代 结果 误差 较 大 时 ， 达 代 次 数 明 显 增 加 (表现 在 从 初始 位 姿 到 线段 始 闹 研 的 
逆 解 求解 过 程 中 )， 而 在 后 续 满 足 lmm 插 补 精度 的 微 变 连续 点 的 逆 解 求 结 过 程 中 ， 迭 代 次 数 
大 幅 下 降 ， 在 收敛 误差 限 stol =10” mm 时 ， 只 要 一 次 迭代 计算 就 可 以 得 出 满足 误差 限 要 求 的 
运动 学 逆 解 。 说 明 算法 收敛 过 程 满足 最 小 能 量变 化 原则 ， 实 现 了 预期 设计 目的 。 

stol 分 别 等 于 10 、10 、10 “时 的 各 揪 补 点 逆 解 耗 时 如 图 6-36 所 示 。 

2) 算法 内 部 耗 时 评估 实验 。 之 后 对 算法 的 各 个 执行 部 分 进行 分 别 计时 统计 ， 发 现 算法 中 
时 间 资 源 消 耗 最 大 的 部 分 为 雅 可 比 窍 阵 y7 的 广义 逆 . 厂 计算 ， 有 其 体 来 说 ， 是 求解 广义 揽 过 程 中 
的 SVD 分 解 部 分 占用 了 较 多 算法 时 间 。 单 次 逆 解 计算 中 SVD 分 解 执 耗 时 及 平均 时 间 占 用 比 
例 见 表 6-7。 
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stol=10-!1 时 的 各 点 逆 解 耗 时 
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图 6-36 stol 分 别 等 于 102、103、104 时 的 各 插 补 点 逆 解 耗 时 
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表 6-7 单 次 遂 解 计算 中 SVD 分 解 执 耗 时 及 平均 时 间 占 用 比例 


stol/mm 最 大 耗 时 /s 平均 耗 时 /s 平均 时 间 占 用 比例 
107 0.0307 0.0067 61.98% 
10-1 0.0177 0.0028 $7.86% 


由 表 6-7 可 见 ，SVD 分 解 占 用 了 运动 学 逆 解 求 结 过 程 中 一 半 以 上 的 时 间 。 午 顿 -拉夫 进 和 迭 
代 法 与 其 他 基于 雅 可 比 广义 逆 的 算法 局 限 性 相同 ， 即 对 雅 可 比 窍 阵 了 的 SVD 分 解 占 用 时 间 资 
源 过 多 ， 算 法 对 便 件 系统 要 求 较 局 。 

各 皇 补 点 逆 解 计算 中 SVD 分 解 执行 耗 时 及 平均 时 间 占 用 比例 原始 数据 如 图 6-37 所 示 。 

由 于 在 执行 过 程 中 , 计时 函数 etime 和 clock 也 需要 占用 时 间 ， 而 针对 单 次 逆 解 的 SVD 分 
解 时 间 消 耗 计算 与 迭代 次 数 有 关 ， 当 stol =10“mm 时 ， 微 变 插 补 点 之 间 仍 需要 三 次 迭代 才 可 
得 到 满足 收 钱 误 开 限 的 运动 学 逆 解 ， 调 用 计时 函数 的 次 数 增加 一 定 程度 上 造成 了 计时 的 不 准 
确 性 。 因 此 只 对 于 stol=107mm 、 stol=107mm 时 的 数据 进行 了 分 析 。 这 一 点 从 侧面 反映 了 
使 用 MATLAB 仿真 进行 算法 效率 分 析 的 局 限 性 。 
stol=10-3 时 的 各 点 逆 解 过 程 中 SVD 分 解 耗 时 
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图 6-37 各 搬 补 点 逆 解 计算 中 SVD 分 解 执 行 耗 时 及 平均 时 间 占 用 比例 原始 数据 


@ 


大 学 生 课 外 科技 创新 竞赛 获奖 作品 精 析 


stol=10-1 时 的 各 点 逆 解 过 程 中 SVD 分 解 耗 时 
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二 stol=10-1 时 的 各 点 逆 解 过 程 中 SVD 分 解 所 占 时 间 比 例 
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图 6-37 各 插 补 点 这 解 计算 中 SVD 分 解 执行 耗 时 及 平均 时 间 占 用 比例 原始 数据 ( 续 

(4) 逆 运 动 学 仿真 结果 分 机 ”通过 对 比 可 得 ， 使 用 解析 法 求 逆 解 ， 对 于 “新 型 工业 焊接 
机 械 臂 ”的 参数 来 说 ， 算 法 的 解 算 速度 非常 快 。 使 用 牛顿 -拉夫 逊 迭 代 法 求 逆 解 ， 算 法 的 时 间 
开销 比较 大 ， 尤 其 对 于 SVD 分 解 的 部 分 ， 如 果 使 用 的 磐 入 式 系 统 处 理 需 性 能 较 甜 ， 讼 算法 的 
执行 效率 将 相当 低下 。 

对 于 本 设计 中 使 用 的 众 入 式 控制 系统 核心 STM32F1VET6 的 Cortex-M3 CPU 没有 浮 点 运 
算 单 元 ， 使 用 定点 DSP 算法 优化 算法 效率 ， 而 且 机 械 臂 在 设计 阶段 有 对 目 由 度 配置 进行 合理 
设计 ， 符 合 Pieper 准则 。 而 牛顿 -拉夫 逊色 代 法 的 优点 主要 体现 在 对 于 非 Pieper 准则 机 械 辟 、 
处 理 奇异 性 问题 、 元 余 自 由 度 控 制 及 对 于 多 解 的 选择 等 方面 。 因 此 对 于 本 系统 ， 优 先 使 用 解 
析 法 进行 运动 学 这 解 求解 。 

2. 轨迹 规划 算法 仿真 

(1) 简单 空间 直线 插 补 仿真 ”对 6.3.3 节 所 述 空间 直线 轨迹 搬 补 算法 进行 仿真 。 以 齐 次 变 
换 阵 形式 给 出 的 端点 仿真 样本 为 
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将 仿真 样本 代入 空间 和 直线 轨迹 规划 算法 ， 可 得 下 线 插 补 与 五 次 样 条 曲线 插 补 的 结果 ， 如 


图 6-38 和 图 6-39 所 示 。 
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图 6-38 ”直线 插 补 结果 


五 次 样 条 曲线 插 补 位 置 线 
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图 6-39 五 次 样 条 曲线 插 补 的 结果 





在 图 6-38 中 ， 轨 迹 对 应 的 X、Y、Z 三 个 坐标 轴 对 应 分 量 的 位 置 / 时 间 曲 线 为 糙 率 一 定 的 
直线 ; 速度 /时 间 曲 线 在 位 置 /时 间 直 线 的 毛 点 处 表现 为 阶 跃 ， 其 他 部 分 为 色 速 状态 ;加 速度 时 
间 曲 线 在 位 置 /时 间 直 线 的 抛 点 处 表现 为 罕 脉 冲 ， 其 他 部 分 为 0。 

在 图 6-39 中 ， 轨 迹 对 应 的 X、Y、Z 三 个 坐标 轴 对 应 分 量 的 位 置 / 时 间 曲 线 为 “S” 形 曲线 

(五 次 曲线 )， 有 平缓 的 过 小 段 ， 速度 /时 间 曲 线 表现 为 平滑 的 钟 形 曲线 《“ 四 次 曲线 ) 加 速度 / 
时 间 曲 线 表现 为 具有 三 个 单调 区 间 的 平滑 样 条 曲线 〈 三 次 曲线 )。 由 实验 结束 可 知 ， 在 伺服 控 
制 所 需 的 位 置 、 速 度 、 加 速度 范围 内 ， 五 次 样 条 曲线 插 补 算法 保证 了 控制 量 关 于 时 间 连 续 可 
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导 ， 且 导数 连续 的 平滑 特性 。 
(2) 连续 轨迹 插 补 仿真 ， 接 下 来 对 连续 刀 路 进行 仿真 ， 以 NC 代码 形式 给 出 的 仿真 轨迹 
为 如 图 6-40 所 示 的 共有 起 止 点 路 径 的 空间 正方 形 。 
N80GOX25.000Y25.0002Z5.000 
N90G120.000F720.0 
N100G1Y75.000F2520.0 
N110X75.000 
N120Y25.000 
N130X25.000Y25.000 
N140G0Z5.000 
N150X0.000Y0.000 
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图 6-40 具有 ZZ 轴 起 止 点 的 平面 矩形 轨迹 


分 别 使 用 直线 插 补 算法 和 五 次 样 条 曲线 插 补 算法 进行 插 补 并 进行 解析 法 求 逆 解 的 各 轴 角 
位 置 / 时 间 曲 线 如 图 6-41 和 图 6-42 所 示 。 
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图 6-41 了 平面 滤 形 轨迹 直线 插 补 关 市 空间 位 症 / 时 间 曲 线 
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图 6-42 ”平面 沧 形 轨迹 五 次 样 条 插 补 关 市 空间 位 置 /时 间 曲 线 
由 图 6-41 中 仿真 结 采 可 知 ， 篆 卡尔 绝对 坐标 系 下 的 直线 经 过 直线 搬 补 ， 并 进行 运动 学 逆 
解 后 ， 得 到 的 结束 为 在 关节 具 有 很 多 不 可 导 的 扎 点 ， 这 些 殷 点 对 应 华 卡 尔 绝对 坐标 系 中 的 
扩 。 这 些 按 点 体现 为 天 市 空间 速度 天 量 的 阶 距 ， 不 利于 控制 。 经 过 五 次 样 条 曲线 插 补 的 结果 
经 过 运动 学 逆 解 后 ， 得 到 的 关节 空间 曲线 具有 与 笛 卡 尔 绝对 坐标 系 下 对 应 的 平 请 性 ， 实 现 了 
预期 的 速度 与 加 速度 控制 功能 。 


【起 和 主要 创新 点 及 取得 的 成 条 


6.4.1 “作品 主要 创新 挟 


本 项 目 设计 的 新 型 工业 焊接 机 械 辟 具有 如 下 创新 点 : 

(1) 机 械 臂 结构 设计 的 原创 性 ”针对 激光 点 焊 等 精密 加 工 环境 ， 本 项 目 组 将 传统 焊接 机 
械 辟 的 5 自由 度 扩展 至 6 自由 度 ， 对 6 自由 度 串 联 关节 型 机 械 臂 的 结构 进行 再 设计 ， 对 应 实 
际 喜 件 选 型 ， 根 据 精 密 加 工 领域 的 应 用 背景 需要 对 具体 的 目 由 上 度 配置 和 结构 设计 进行 了 优化 。 
并 在 此 基础 之 上 引入 创新 性 的 质量 式 目 适应 力 算 控制 机 构 ， 将 多 轴 联 动 可 控 目 由 度 提 升 到 了 
“6+1” 的 水 平 。 

(2) 运 控 算 法 的 创新 性 ”国际 市 场 对 于 $ 轴 以 上 联动 的 多 轴 运 探 产品 在 核心 技术 方面 对 
我 国 仍然 采取 技术 封锁 的 政策 ， 国 内 的 多 轴 运 控 搁 术 还 处 于 较 低 水 平 ， 尤 其 在 技术 理论 的 具 
体 实现 方面 。 本 项 目 根据 激光 点 焊 技 术 的 精度 需要 ， 人 针对 租 入 式 控制 平台 的 便 件 特性 ， 分 运 
动 学 算法 、 轨 迹 规 划算 法 与 目 适 应 力矩 控制 算法 三 个 部 分 展开 了 运动 控制 算法 的 设计 。 其 中 
运动 学 算法 包括 运动 学 正解 、 解 析 法 求 逆 解 、 牛 顿 -拉夫 进 迭 代 法 求 逆 解 三 个 部 分 ， 轨 迹 规 划 
算法 包括 直线 插 补 算法 与 五 次 样 条 曲线 插 补 算法 两 部 分 ， 力 和 矩 目 适应 控制 包括 静 力 平衡 与 财 
环 动力 平衡 两 部 分 。 对 于 涉及 的 全 部 7 个 子 算法 ， 均 进行 了 过 程 严密 的 数学 推导 ， 以 程序 代 
公 的 形式 予以 实现 ， 并 经 过 了 仿真 与 实验 验证 。 

(3) 控制 系统 架构 创新 ”设计 了 基于 Cortex-M3 ARM 硬件 核心 和 uCos-I RTOS 的 嵌入 式 控 
制 系统 。 通 过 对 IQMATH DSP 汇编 库 及 CMSIS DSP C 语言 库 的 移植 ， 大 幅 提 高 了 关节 坐标 变换 
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中 超越 函数 与 朱 阵 、 行 列 式 运算 的 运算 速度 。 基 于 以 上 系统 优化 设计 ， 以 低廉 的 成 本 在 航 入 式 系 
统 中 实现 了 复杂 的 实时 运 控 算 法 。 实 现 焊 接 机 械 臂 的 高 精度 、 高 效率 空间 轨迹 摘 述 和 路 径 规 划 。 

(4) 控制 方式 的 创新 ”通过 UCGUI 的 移植 ， 看 重 进 行人 机 界面 的 设计 ， 一 方面 开发 新 的 
未 教 控 制 方式 。 男 一 方面 ， 兼 容 现 有 的 CNC 数控 机 床 编 程 标准 ， 实 现 传统 式 的 操作 。 大 大 简 
化 了 设备 使 用 和 维护 的 难度 。 

本 项 目 设计 的 新 型 工业 焊接 机 械 臂 具有 如 下 新 于 性 : 

(1) 根据 具体 问题 从 解决 方案 层面 设计 系统 本 项 目 以 激光 点 焊 和 精密 加 工 的 实际 问题 
为 切入 点 ， 为 解决 此 类 生产 问题 提供 系统 层次 的 解决 方案 ， 涵 盖 工 业 机 械 辟 所 涉及 的 目 动 控 
制 、 机 械 设 计 、 驱 动 伺服 、 人 机 交互 界面 、 上 下 位 机 交互 ， 多 机 组 网 交互 等 组 成 部 分 。 力 求 
在 满足 系统 性 能 指标 的 前 提 下 ， 对 每 一 部 分 使 用 最 优化 的 资源 配置 。 作 为 应 对 工业 生产 实际 
问题 的 完善 解决 方案 ， 具 有 系统 层面 的 新 于 性 。 

(2) 成 功 构建 了 针对 多 轴 运 控 的 里 片 移 入 式 控 制 系统 ”由 于 便 件 构架 和 指令 系统 与 通用 
CPU 的 区 别 , 租 入 式 控制 系统 在 算法 实现 和 优化 上 与 传统 的 工控 PC 和 PLC 有 着 很 大 的 区 别 ， 
传统 的 算法 直接 移植 到 髓 入 式 人 硬件 上 需要 消耗 巨大 的 时 间 资 源 ， 且 无 法 保证 控制 的 实时 性 。 
因此 为 了 弥补 运算 速度 与 实时 响应 能 力 的 不 足 ， 现 有 的 控制 系统 多 数 基 于 ARM 与 DSP 或 
ARM 与 FPGA 的 混合 控制 ， 没 有 真正 体现 出 移入 式 控制 系统 低 成 本 、 构 架 人 简洁 与 高 灵活 性 、 
高 度 特 化 的 特点 。 随 看 便 件 技术 的 不 断 发 展 , 尤其 是 ARM CORTEX-M 系列 32 位 工业 控制 IP 
核 的 问世 ， 以 及 各 大 半导体 器 件 商 的 大 力 文 持 ， 催 生 了 以 意 法 半导体 的 STM32 和 NXP 的 
LPC3250 为 代表 的 高 性 能 工控 MCU。 强 大 的 处 理 器 和 功能 完备 的 外 设 构成 的 MCU 为 单 厂 艇 
入 式 控制 系统 的 实现 ， 提 供 了 坚实 可 菲 的 方案 文 持 。 

本 设计 基于 STM32 构建 了 简洁 的 嵌入 式 软 人 硬件 构架 ， 通 过 对 Thumb-2 指令 集 内 DSP 指 
令 和 汇编 算法 的 优化 ,实现 了 超越 函数 和 算 阵 运算 在 ARM 核 内 的 高 速 运算 ; 充分 利用 折 内 外 
设 ， 使 用 外 设 驱 动 外 围 便 件 和 便 件 接 口 电 路 ， 不 占用 CPU 资源 ; 结合 实时 操作 系统 uCOS/II 
的 引入 ， 在 保证 算法 实时 、 高 速 、 精 准 的 前 提 下 ， 构 建 了 友好 的 人 机 界面 ， 最 终 成 功 设 计 了 
单 片 伦 入 陈 控 制 解 决 方案 。 


6.4.2 ”作品 取得 的 成 果 


作品 取得 的 成 果 如 下 : 

1) 新 型 工业 焊接 机 械 辟 原理 样机 1 合 。 

2) 新型 工业 焊接 机 械 臂 研究 技术 报告 1 份 。 

3) 获得 第 八 届 “ 世 纪 杯 ”北京 理工 大 学 课外 学 术科 技 作 品 竞赛 一 等 奖 。 


忆 结 与 展望 


6.5.1 作品 研 上 工作 总 结 


本 项 目 在 系统 层面 上 由 实际 问题 出 发 ， 设 计 实现 了 整套 工业 机 械 辟 系统 。 实 现 了 预期 性 
能 指标 要 求 ， 虽 然 由 于 成 本 押 限 ， 体 服 电动 机 和 减速 句 及 位 置 反 饿 传感器 的 性 能 限制 ， 第 一 
代 实 验 样 机 性 能 仍 有 提高 空间 ， 但 是 整个 系统 的 功能 架构 和 算法 的 性 能 均 得 到 了 验证 。 
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项 目的 研究 价值 主要 体现 在 以 下 四 个 方面 : 

1) 控制 系统 的 使 件 与 软件 设计 。 通 过 对 工业 机 械 臂 系统 进行 功能 性 需求 分 机 ， 确 定 了 藤 
入 式 控制 系统 的 系统 层级 与 整体 架构 ， 经 过 方 采 论 证 与 右 件 选 型 ， 完 成 了 髓 入 式 人 蚀 件 系统 的 
设计 ， 在 此 基础 之 上 完成 了 风 入 式 软 件 系 统 与 相关 接口 软件 的 开发 。 

2) 运动 控制 握 法 的 设计 与 实现 。 分 运动 学 算法 、 轨 迹 规 划算 法 与 目 适 应 力 算 控制 算法 三 
个 部 分 展开 了 运动 控制 算法 的 设计 。 其 中 运动 学 算法 包括 运动 学 正解 、 解 析 法 求 敢 解 、 牛 顿 - 
拉夫 逊 迭 代 法 求 逆 解 三 个 部 分 。 轨 迹 规划 筑 法 包括 直线 插 补 算法 与 五 次 样 条 曲线 插 补 算法 两 
部 分 。 力 矩 目 适应 控制 算法 包括 静 力 平衡 与 朵 环 动力 平衡 两 部 分 。 对 于 涉及 的 全 部 7 个 子 算 
法 ， 均 进行 了 过 程 严密 的 数学 推导 ， 以 程序 代 人 码 的 形式 予以 实现 ， 并 经 过 了 仿真 与 实验 验证 。 

3) 验证 实验 的 设计 与 评估 。 针 对 设计 的 运动 控制 算法 ， 设 计 了 相应 的 验证 仿真 实验 ， 对 
于 运动 学 算法 ， 分 别 对 两 种 运动 学 逆 解 求解 算法 的 执行 速度 与 效率 进行 了 对 比 实验 ， 分 析 了 
两 种 算法 的 特性 ， 对 于 插 补 算法 ， 通 过 篆 卡 尔 系 中 与 关节 空间 中 的 位 置 、 速 度 、 加 速度 的 规 
划 效 采 ， 对 两 种 插 补 算法 的 效果 进行 了 对 比 。 

4) 在 基于 虚拟 样机 扩 术 的 上 位 机 软件 开放 方面 ， 虚 拟 仿真 测试 平 侣 的 设计 上 ， 对 平台 子 
模块 的 功能 进行 了 详尽 的 分 析 与 代码 实现 。 在 子 模块 功能 代码 化 的 过 程 中 ， 对 具体 的 关键 拉 
术 与 编程 细节 展开 了 详细 讨论 ， 并 从 中 选择 最 优 方 案 进行 编程 实现 。 


6.S.2 ”展望 


(1) 控制 系统 硬件 平台 性 能 的 提升 “目前 的 硬件 性 能 对 系统 性 能 造成 了 制约 ， 主 要 体现 
在 STM32F1 系列 使 用 的 Cortex-M3 核心 主 频 只 能 达到 72MHz, 而 且 没 有 浮 点 运算 单元 的 辅助 ， 
完全 靠 定 点 算法 优化 来 提升 运算 能 力 效 果 有 限 。 在 之 后 进一步 的 研究 过 程 中 ， 预 期 使 用 
Cortex-M4 核心 的 STM32F4 系列 微 控 制 器 ， 主 频 提 升 的 同时 ， 片 内 具备 浮 点 运算 单元 ， 更 加 
适合 于 实时 多 轴 联 动 运 动 控制 。 

(2) 运 控 算法 的 进一步 推广 ”本 项 目 设 计 的 控制 对 象 “ 新 型 机 械 臂 ”属于 符合 Pieper 准 
则 的 腕 解 粳 机 械 医 ， 对 于 该 种 日 由 度 配 置 ， 解 析 法 求人 逆 解 共有 绝对 的 速度 优势 ， 但 是 对 于 更 
加 普遍 的 情况 ， 需 要 算法 具有 更 加 普遍 性 的 适应 性 ， 迭 代 法 的 优势 开始 凸显 。 在 之 后 的 项 目 
中 ， 应 该 对 更 加 普 志 的 机 械 臂 自由 度 配 置 、 并 联系 统 和 元 余 自 由 度 系统 下 的 运动 学 算法 展开 
深入 的 研究 。 

(3) 建 模 阶 数 的 提高 和 控制 参数 的 精确 在 设计 过 程 中 ， 关 于 运动 学 的 研究 和 分 析 属 于 
基于 扔 点 零 冲 量 假设 六 提 下 的 ， 有 具有 速度 和 加 速度 规划 的 位 置 伺服 控制 。 运 动 学 分 析 中 只 用 
到 一 阶 的 雅 可 比 和 矩阵， 所 以 控制 仍 属 于 速度 和 静 力 范畴 。 而 机 械 臂 控制 过 程 中 的 动力 学 过 程 
将 更 为 复杂 ， 因 此 在 后 续 的 研究 中 ， 如 何 将 现 有 的 运 控 算法 通过 建 模 阶 数 的 进一步 提高 ， 推 
广 到 动力 学 范畴 将 是 本 项 目 方 癌 以 后 发 展 的 重点 。 
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第 7 章 ”边缘 救援 平台 
(第 四 局 全 国 大 学 生机 械 创新 设计 大 赛 一 等 奖 ，2010 年 ) 


周作 品 研 究 9 育 景 及 意义 


边缘 地 带 ， 尤 其 是 在 山崖 、 人 矿井 边 ， 由 于 其 特殊 的 地 形 ， 是 人 们 容易 失足 发 生 附 落 事故 
的 地 带 ， 大 要 在 这 类 地 市 展 开 施 救 ， 时 常 需要 动用 大 量 的 人 力 、 物 力 ， 并 且 由 于 此 类 专业 救 
授 问 械 相 对 较 少 ， 救 援 人 员 往 往 不 配备 此 类 需 械 。 施 救 时 只 能 采用 一 些 蔡 代 方法 ， 而 且 这 些 
方法 通 癌 具有 很 强 的 针对 性 ， 不 只 通用 价值 ， 导 致 现 有 的 救援 方式 既 训 时 义 避 力 ， 无 法 确保 
救援 的 安全 性 ， 更 无 从 保证 减少 伤员 的 接触 性 疼痛 和 二 次 受伤 。 

在 悬崖 、 矿 井 等 边缘 地 带 发 生 的 事故 ， 因 为 地 形 复杂 ， 救 援 难度 大 ， 上 所 以 很 难 找到 有 效 的 
专用 喜 材 ， 国 内 现 有 的 产品 主要 是 以 三 脚 架 作为 文 撑 工 具 ， 再 辅 以 需 大 量 人 力 的 豆 材 ， 但 此 关 
八 材 效 识 低下 、 对 于 被 救援 人 人 员 的 保护 有 限 ， 人 往往 经 过 一 番 救 援 的 “折腾 ”， 伤 员 的 伤势 更 趋 
严重 。 图 7-1 所 示 的 三 脚 染 救援 系统 ， 存 在 操作 难度 大 、 效 率 低 、 伤 员 容 易 二 次 受伤 等 问题 。 



























7-1 国内 外 常见 三 脚 染 救援 系统 


国外 现 产 的 相关 产品 与 国内 的 产品 大 同 小 卉 ， 也 存在 看 同样 的 问题 。 据 调 碍 ， 国 内 的 产 
品 绝 大 多 数 都 是 国外 进口 或 在 国外 产品 的 基础 上 改造 而 成 的 。 

针对 专业 边缘 救援 器 械 市 场 优 秀 产品 数量 少 、 产 品种 类 少 、 通 用 功能 少 的 状况 ， 本 作品 
利 在 设计 出 一 珀 可 用 于 边缘 救援 的 专业 产品 ， 能 够 将 市 场 现 有 的 救援 三 脚 架 与 医用 担架 通过 
绳索 拖 搜 系统 结合 起 来 ， 通 过 机 电 一 体 化 设计 ， 配 上 相应 的 保护 设施 ， 使 其 具有 局 效 、 安 全 、 
可 有 效 保护 被 救 伤员 的 特点 ， 能 够 适应 山体 复杂 地 形 条 件 ， 殉 服 地 形 师 蚁 、 救 援 困难 等 情况 ， 
减少 被 施 救 者 在 救援 过 程 中 的 二 次 受伤， 快速 而 安全 地 将 伤 者 救出 险 地 。 

边 绿 救援 乎 台 由 拖 搜 系 统 和 救援 担架 系统 两 部 分 组 成 。 

拖 搜 系统 由 三 脚 架 、 绞 盘 、 钢 丝 强 和 动力 系统 组 成 。 其 中 可 灵活 调 市 的 三 脚 染 能 适应 复 
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杂 的 崖 边 地 形 而 起 到 有 效 的 支撑 作用 ; 绞 各 、 钢 丝 强 和 动力 系统 有 机 结合 ， 可 实现 救援 担架 
系统 的 可 靠 收 放 ， 钢丝 绳 分 主 副 两 套 ， 主 缠 起 主要 拖 动作 用 ， 副 绳 则 在 主 强 失效 的 情况 下 起 
保护 替代 作用 ， 同 时 又 有 一 定 的 导向 和 定位 功能 

救援 担架 系统 由 担架 及 其 外 部 起 保护 作用 的 壳 体 结构 组 成 。 流 线 型 的 壳 体 结构 能 有 效 殉 
服 复杂 地 形 的 不 利 影响 。 其 日 市 一 套 控 制 系 统 和 减 震 装置 ， 以 保证 被 施 救 者 在 上 升 过 程 中 相 
对 平稳 ， 使 伤 者 避免 受到 二 次 伤害 。 

本 作品 在 设计 过 程 中 充分 考虑 山体 边缘 地 带 的 地 形 及 被 施 救 者 的 受伤 情况 ， 充 满 人 性 化 
设计 ， 是 一 球 安 全 、 可 靠 、 高 效 的 专业 救援 作品 。 


作品 概述 
7.2.1 研究 内 容 概述 
1. 救援 平台 整体 设计 
边缘 救援 平台 系统 组 成 框图 如 图 7-2 所 示 。 根 据 设 计 要 求 加 工 制 作出 平台 实物 样机 ， 如 


图 7-3 所 示 ， 并 完成 了 测试 。 
边缘 救援 平台 


拖 搜 系 统 












救援 担架 系统 
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图 7-3 ”边缘 救援 平台 实物 样机 图 
平台 整体 由 拖 搜 系统 和 救援 担 染 系统 两 部 分 组 成 ， 并 考 翌 到 针对 边 缘 救援 复 林 的 地 形 环 
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境 ， 救 援 装置 的 支撑 固定 是 实施 救援 必 不 可 少 的 前 提 条 件 ， 因 此 救援 平台 拖 搜 系统 包括 角度 
和 长 度 均 可 调 的 救援 三 脚 架 ， 以 保证 整套 装置 在 复杂 地 形 中 有 可 靠 的 国定 连接 。 

2 救援 平台 拖 搜 系统 设计 

救援 平台 的 拖 搜 系 统 是 通过 对 救援 现场 地 形 进 行 分 析 ， 在 救援 三 脚 架 和 绞盘 的 基础 上 拱 
建 的 一 套 具备 拖 搜 功能 并 起 到 支撑 保护 作用 的 系统 。 该 系统 主要 由 三 脚 架 、 绞 盘 与 强 索 、 拖 
搜 电动 机 与 传动 系统 组 成 。 

系统 中 使 用 三 脚 架 的 设计 目的 是 为 避免 在 救援 过 程 中 由 于 绳索 无 法 固定 而 造成 平台 在 救 
援 过 程 中 大 幅度 摆动 所 带 来 救援 过 程 不 畅 和 可 能 造成 二 次 伤害 的 危险 。 考 虑 到 为 了 减少 绳索 
与 崖 边 突 棱 的 磨损 ， 需 要 将 绳索 在 岸 边 利用 支架 支撑 以 远离 崖 边 。 

为 实现 救援 担架 系统 快速 安全 的 雁 引 拖 搜 ， 绞 担 与 绳索 系统 具有 很 高 的 安全 性 设计 要 求 。 
项 目 组 设计 出 包含 三 套 拖 搜 绳索 的 绳索 装置 ， 即 一 套 主 强 和 两 套 副 绳 。 主 绳 承受 主要 的 拉力 ， 
起 着 拖 搜 的 作用 ;， 副 绳 将 作为 元 余 安全 性 设置 ， 并 为 救援 担架 系统 提供 导向 功能 防止 出 现 担 
架 翻滚 的 情况 。 

3， 救援 担架 系统 设计 

边缘 救援 平台 的 救援 担架 系统 又 称 为 救援 抢 ， 作 用 是 保护 和 运载 伤员 ， 在 拖 搜 系统 的 牵 
引 下 ， 将 伤 者 安全 快速 地 从 山崖 底部 运送 至 安全 施 救 地 带 。 

救援 舱 将 采用 特殊 的 外 形 设计 ， 能 够 快速 、 平 稳 、 安 全 地 在 山体 表面 运动 。 同 时 充分 考 
虑 到 被 救援 人 身体 状况 的 特殊 性 ， 救 援 骏 在 设计 时 就 着 重 考虑 了 减 震 系统 和 自 平衡 系统 ， 使 
被 救援 人 员 能 够 尽 可 能 和 舒适、 安全、 快速 地 运输 到 地 面 。 

救援 骏 工 作 在 陡峭 崎 贱 的 山体 表面 ， 要 想 将 伤 者 从 山崖 下 安全 快速 运送 到 地 面 面 临 兰 干 难 
题 。 在 山体 表面 运行 时 必然 会 使 一 般 的 救援 工具 产生 翻滚 运动 ， 因 此 ， 在 纵横 两 个 方向 上 设计 
了 一 套 双 自由 度 调 节 的 自 平衡 系统 。 在 横向 上 ， 从 滚动 轴承 的 结构 形式 得 到 启发 ， 将 救援 舱 设 
计 为 内 外 两 层 可 相对 转动 的 结构 ， 同 时 配合 具有 角 位 置 测量 装置 的 伺服 控制 系统 (类 似 于 飞机 、 
导弹 等 的 滚 转 角 位 置 稳定 系统 ), 可 使 内 层 在 横向 上 始终 保持 在 一 个 预定 的 稳定 位 置 。 在 纵向 上 ， 
为 了 改善 伤 者 在 上 升 过 程 中 的 受 力 情况 ， 减 轻 伤 者 在 被 拖 搜 过 程 中 的 痛苦 ， 同 时 避免 伤 者 头 部 
朝 下 造成 脑 充血 ， 设 计 出 一 套 曲柄 滑 块 机 构 ， 将 担架 作为 曲柄 滑 块 机 构 的 连 杆 ， 以 丝 杠 螺母 作 
为 传动 件 ， 控 制 步 进 电动 机 ， 通 过 运动 传递 ， 使 担架 绕 一 支点 转动 ， 对 其 俯仰 角 进 行 调节 。 

在 山体 表面 运动 面临 的 另外 一 个 难题 就 是 救援 物体 可 能 在 横向 上 产生 大 范围 的 移动 ， 采 
用 三 绳 滨 引 机 制 以 解决 此 问题 。 其 中 一 根 钢 绳 作为 主要 的 拉 伸 动力 来 源 ， 拉 动 救援 舱 向 上 运 
动 ， 两 根 辅助 钢丝 绳 作为 辅助 定位 作用 ， 辅 助 钢丝 绳 将 直接 穿 过 救援 抢 ， 一 端 固定 于 山崖 底 
部 ， 使 救援 舱 的 运动 轨迹 接近 从 山体 上 面 的 施 救 点 到 山崖 底部 的 被 救 点 的 一 条 直线 上 。 为 了 
避免 救援 肥 在 山体 表面 运动 时 产生 的 剧烈 震动 对 被 救 伤员 的 影响 ， 设 计 出 比较 完善 的 减 震 系 
统 ， 利 用 两 级 减 震 环节 使 最 终 传递 到 伤 者 的 震动 减弱 为 最 低 。 


7.2.2 ”技术 指标 


救援 平台 的 技术 指标 如 下 : 
1) 救援 舱 长 三 1400mm， 舱 体 直径 三 650mm， 滑 权 间 距离 生 700mm， 舱 重 三 20kg， 有 效 
负载 70kg。 
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2) 绳索 工作 平均 速度 为 0.12m/s， 上 共有 定位 收 放 和 防止 与 边缘 俯 石 等 物体 接触 造成 磨损 
的 功能 。 

3) 拖 搜 系统 具备 防止 救援 舱 在 拖 搜 过 程 中 翻滚 俩 离 的 功能 ， 且 拖 搜 绳索 设计 具有 允 余 安 
全 性 。 

4) 具有 备用 动力 系统 ， 可 在 能 源 中 断 情 况 下 持续 工作 ， 有 具备 快速 切换 动力 装置 ， 你 证 整 
套 姜 置 在 救援 过 程 中 有 可 徘 的 动力 来 源 。 

5) 救援 舱 有 具备 防止 翻 深 能 力 ， 并 上 共有 多 重 减 瑚 措施 。 


[用 j 关键 报 术 


7.3.1 ”救援 平台 工作 流程 


救援 平台 工作 流程 如 下 : 

1) 拖 搜 系统 、 救 援 担 染 系 统 各 环 各 位 。 

2) 起 动 拖 搜 系 统 电动 机 ， 同 时 一 写 、 二 号 电磁 离合 器 工作 ， 电 动机 带动 主 副 绞盘 同时 转 
动 ， 将 救援 担架 系统 从 山崖 上 放下 ， 直 至 到 达 伤 者 附近 。 离 合 器 与 绞盘 如 图 7-4 所 示 。 

3) 关 停 电动 机 ， 一 、 二 号 电磁 离合 器 同时 
胶 开 。 锁 死 两 副 绞 盘 轴 ， 这 是 为 了 预防 在 问 上 
拉 起 救援 担架 系统 和 伤 者 时 主 绳 失效 而 专门 设 
计 的 保护 环节 。 

4) 当 伤 者 已 进入 救援 担架 系统 时 , 起 动 拖 
搜 系 统 电 动机 ， 使 电动 机 反 转 ， 电 磁 离 合 右 1 
工作 ， 电 人 磁 离 合 占 2 保持 断 开 。 这 样 电动 机 便 
带动 主 绞盘 收 扰 主 强 ， 通 过 主 绳 将 救援 担架 系 
统 拉 上 来 。 两 根 副 绳 并 不 随 之 收 起 ， 仍 然 起 着 -一 一、 
保护 和 导 癌 作用 。 图 7-4 ”离合 器 与 绞盘 

5) 当 伤 者 和 救援 担 染 系统 顺利 达到 崖 上 ， 救 援 成 功 后 ， 电 动机 停 转 ， 电 磁 离 合 器 1 嘱 开 ， 
用 手 轮 将 两 根 副 强 收 起 。 至 此 ， 边 缘 救 援 工作 结束 。 

救援 平台 模拟 开展 救援 工作 示意 图 7-5 所 示 。 
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图 7-5 救援 平台 模拟 开展 救援 工作 示意 图 
a) 拖 搜 系统 b) 工作 过 程 
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7.3.2 ” 拖 搜 系统 设计 计算 

1. 三 脚 架 设计 计算 

考虑 到 施 救 工作 是 在 山崖 边 上 进行 的 ， 山 崖 地 形 复 杂 ， 地 势 不 平 ， 因 此 绳索 的 固定 十 分 
不 易 。 为 了 减少 绳索 与 峙 边 突 校 的 磨损 ， 需 要 将 绳索 在 尾 边 处 文 撑 起 来 。 绽 合 考 夸 上 述 特殊 
情况 ， 选 用 三 脚 架 作为 支撑 工具 ， 并 起 到 对 拖 搜 绳索 的 导向 作用 。 其 三 个 支 脚 均 可 绕 备 自 的 
轴 转 动 ， 使 各 个 支 脚 可 在 一 定 的 范围 内 找到 合适 的 地 点 固定 。 其 中 一 支 脚 较 长 并 可 进行 长 度 
的 调整 ， 固 定 在 离 是 边 稍 远 的 小 车 上 ， 小 车 可 与 地 和 耐 固定 。 该 设计 可 减少 三 脚 染 在 承受 较 大 
蔡 矩 时 翻 倒 的 可 能 性 。 而 传统 的 三 脚 架 三 个 文 脚 一 样 长 ， 因 此 必须 通过 辅助 绳索 的 拉 搜 才 能 
保证 其 不 会 翻 倒 。 三 脚 架 如 图 7-6 所 示 。 

三 脚 架 由 三 根 可 调 的 文 脚 1、2、3 组 成 ， 三 根 文 脚 均 可 在 各 上 自 的 平面 内 做 一 定 角度 的 调 
整 ， 文 脚 1 在 与 文 脚 2、3 构成 的 平面 牌 下 。 文 脚 2、3 均 长 900mm， 文 脚 1 与 螺纹 杆 4 通过 
螺纹 配合 ， 可 进行 长 度 方 回 的 调整 。 同 时 螺纹 杆 4 一 高 为 左旋 ， 一 端 为 右 旋 ， 可 实现 两 侧 同 
时 各 外 或 回 里 运动 ， 达 到 快速 调节 长 度 的 目的 ， 如 图 7-7 所 示 。 三 脚 架 的 文 脚 1 固定 长 度 设 
定 为 1100mm, 最 大 长 度 可 达 1300mm。 支 脚 2、3 直接 采用 销 钉 固定 在 地 上 , 销 钉 孔径 为 10mm， 
支 脚 1 可 与 小 车 固定 ， 再 通过 小 车 的 固定 与 地 面 固定 。 图 7-7 所 示 为 螺纹 杆 4 的 双向 螺纹 调 
节 浅 置 。 几 7-8 所 示 为 螺纹 杆 4 的 工程 图 。 




















图 7-6 三 脚 架 图 7-7 双向 螺纹 调节 装置 
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技术 要 求 : 

1. 去 毛刺 

2. 未 注 公 差 等 级 为 IT10 
3. 调 质 处 理 





7-8 螺纹 杆 4 的 工程 图 
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2. 绞盘 设计 计算 

绞盘 系统 由 一 个 主 绞 盘 、 两 个 副 绞 盘 、 布 线 器 和 动力 系统 组 成 。 绞 检 系 统 虚 拟 样机 如 
图 7-9 所 示 。 

由 于 在 拖 动 过 程 中 主 绳索 受 力 较 大 ， 而 山体 地 形 较 为 复 洒 ， 单 一 绳索 拖 搜 救援 担架 系统 的 可 
徘 性 较 难 保障 ， 并 晶 极 易 出 现 翻 深 偏离 情况 。 因 此 在 一 套 主 绳 的 基础 上 ， 增 加 两 套 副 绚 。 一 方面 
副 强 可 在 主 绳 失效 的 情况 下 ， 通 过 救援 担架 过 体 上 闭 有 的 卡 绳 占 ， 牢 国 地 与 救援 担 染 系统 相 接 ， 
起 到 保护 作用 ， 为 一 方面 两 僚 副 强 经 过 分 别 安 装 在 三 脚 染 上 的 滑轮 ， 会 分 开 一 定 的 距离 。 这 样 两 
条 绳 束 构 成 了 一 个 平面， 使 得 救援 担 染 系统 沿 者 一 平 血 运动 ， 在 主 强 将 救援 担 染 系 统 癌 上 拖 搜 过 
程 中 起 a 到 导 问 作 用。 两 套 副 绳 做 同样 的 运动 ， 两 副 绞 盘 共 用 一 根 轴 。 三 套 绞 盘 均 安装 有 布线 器 ， 
可 使 绳索 均匀 地 缠绕 在 丝 盘 轴 上 ， 使 得 绳索 在 拖 搜 过 程 中 处 于 较 佳 的 受 力 状况 。 

绞 损 上 共有 两 套 动 力 系 统 ， 一 套 是 电动 机 驱动 装置 ， 为 一 套 是 手动 驱动 装置 。 系 统 中 ， 电 
动机 输出 靖 通过 减速 费 和 离合 器 ， 再 通过 同步 市 传递 给 主 绞盘 。 主 绞盘 则 通过 离合 占 与 副 弘 
横 相 连 ， 可 以 分 别 实 现 主 绞盘 的 单独 转动 和 主 、 副 绞 稻 的 同时 转动 。 主 副 绞 盘 实 物 图 如 图 
7-10 所 示 ， 副 绞盘 实物 图 如 图 7-11 所 示 。 手 动 驱 动 装置 由 主 绞盘 上 的 手动 新 口 提供 动力 输 
入 ， 如 图 7-12 所 示 。 手 动 端口 所 采用 的 快速 拆 闭 结 构 将 使 得 两 套 动力 猜 置 在 转换 过 程 中 实 
现 快速 切换 ， 节 省 救援 时 间 。 主 、 副 绞盘 则 的 离合 器 在 手动 驱动 条 件 下 同样 能 实现 主 副 绞 盘 
的 选 通 要 求 。 此 外 ， 两 种 动力 来 源 的 设计 ， 一 方面 提高 了 系统 的 可 靠 性 ， 另 一 方面 在 绳索 受 
力 较 小 的 情况 下 使 用 手动 动力 可 以 节省 耗 电量 。 手动 端口 安装 手 轮 实 物 图 与 虚拟 样机 图 如 图 
7-13 所 示 。 

电动 机 、 减 速 器 、 主 副 绞 盘 都 固定 在 小 车 上 。 由 于 小 车 需要 固定 在 山崖 附近 ， 双 考虑 到 
地 形 四 上 晤 不 平 ， 小 车 尺寸 不 宜 太 大 。 为 了 市 约 空 间 ， 电 动机 和 绞盘 的 放置 如 图 7-9 所 示 。 
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图 7-9 绞盘 系统 虚拟 样机 
为 聘 省 经 费 及 加 工时 间 ， 其 中 绞盘 文 染 用 轴承 座 蕉 代 。 经 过 计算 ， 轴 承 选 用 深 沟 球 轴 
承 ， 内 径 为 50mm， 外 径 为 80mm; 轴承 座 中 心 高 度 为 100mm， 底 座 宽 70mm， 长 170mm。 
绞盘 轴承 座 设 计 如 图 7-14 所 示 。 
拖 搜 绳索 选用 钢丝 绳 ， 根 据 设 计 需 求 钢 丝 绳 最 大 承重 为 100kg， 选 用 百人 答 为 4mm 的 钢丝 
绳 。 设 计 绞 检 转 轴 和 直径 为 50mm。 
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图 7-13 手动 端口 安装 手 轮 实物 图 与 虚拟 样机 图 


轴承 应 3 国 | 得 承 应 4 


司 : 


轴承 座 1 所 轴承 座 2 
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图 7-14 绞盘 轴承 座 设 计 
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3. 动力 系统 设计 
根据 项 目 要 求 ， 设 计 负 载 为 70kg， 上 所 需 电 动机 功率 P=7/9.55=700x0.025=*9.55=73.3W。 取 
传动 效率 为 0.4， 故 电动 机 选用 电压 为 220V、 功 率 为 180W 的 交流 电动 机 ， 额 定 转速 为 
135S0rmin。 根 据 设 计 要 求 ， 强 索 运 动 速度 为 0.12m/s，@=v/r=4.8rad/s，n=30@ /n=45r/min， 则 
减速 比 为 1:30， 故 选用 减速 比 为 1:30 的 减速 器 。 同 样 制 作 了 电动 机 的 控制 模块 ， 将 对 电动 机 
和 离合 器 的 开关 及 电动 机 的 转速 进行 控制 。 图 7-15 所 示 为 动力 系统 控制 模块 。 图 7-16 所 示 
为 对 控制 模块 进行 操作 的 示意 图 。 
| 
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7-16 ”对 控 伟 





| 模块 进行 操作 的 示意 区 

4. 传动 系统 设计 与 选 型 

(1) 轴 的 设计 根据 实际 情况 及 经 验 推 理 和 强度 计算 ， 选 取 铝 棒 作 为 轴 材 ， 轴 1 和 轴 2 
的 最 小 直径 为 25mm， 轴 3 最 小 直径 为 20mm。 轴 系 布局 如 图 7-17 所 示 。 轴 1、2、3 的 工程 
图 分 别 如 图 7-18、 图 7-19、 图 7-20 所 示 。 
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7-17 ” 轴 系 布局 
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技术 要 求 : 

1. 未 注 圆 角 R1.5 

2. 未 注 公 差 等 级 为 IT10 

3. 表面 阳极 氧化 处 理 ( 本 色 ) 





图 7-18 轴 1 的 工程 图 
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技术 要 求 : 

1. 未 注 圆 角 R1.5 

2. 未 注 公差 等 级 为 IT10 

3. 表面 阳极 氧化 处 理 〈 本 色 ) 
图 7-19 轴 2 的 工程 图 
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技术 要 求 : 

1. 未 注 圆 角 R1.5 

2. 未 注 公 差 等 级 为 IT10 
3. 表面 阳极 氧化 处 理 ( 本 色 ) 


图 7-20 轴 3 的 工程 图 
(2) 同步 市 的 选用 ”由 于 传输 距离 较 远 ， 且 传动 输入 输出 的 线 速 度 较 低 ， 又 考虑 到 安 闭 精度 
的 问题 ， 故 选用 利用 嘴 合 传动 定律 的 同步 带 作为 传动 装置 。 根 据 电 动机 选 型 中 计算 所 需 功率 
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由 局 


P=73.3W， 并 考 虚 到 传动 的 损失 ， 选 用 齿 形 为 8M 的 圆 孤 齿 同 步 带 ， 结 合 市 场 有 售 同步 带 型 号 调 
研 情况 ， 选 用 的 同步 带 参 数 为 : 带宽 30mm， 带 长 880mm， 贞 数 110。 同 步 带 如 图 7-21 所 示 。 












图 7-21 同步 带 
(3) 离合 器 的 选用 拖 搜 系统 所 用 离合 堪 采 用 电磁 离合 器 。 通 过 调研 市 场 ， 综 合 考虑 产 
品 性 能 ， 选 用 DLD5 系列 的 20/A 型 电 倒 离合器， 扭矩 为 20N。m， 人 额定 电压 为 24V。 


7.3.3 ”救援 担架 系统 设计 
(1) 救援 担架 系统 整体 设计 “根据 设计 要 求 ， 救 援 舱 的 外 形 设计 为 流线型 ， 主 体 呈 柱 形 ， 
头 部 为 锥 形 ， 合 理 的 外 形 设 计 一 方面 可 以 减 小 担架 拖 搜 前 进 中 的 阻力 ， 另 一 方面 使 救援 舱 外 
壳 具 有 一 定 的 破 障 和 越 障 能 力 。 设 计 救 援 舱 全 长 2100mm， 外 圆 半 径 SS$0mm， 滑 要 之 间 的 距 
离 为 610mm。 救 援 担架 外 形 尺 寸 示 意图 和 实物 样机 如 图 7-22 和 图 7-23 所 示 。 
2100 


























外 形 尺寸 示意 图 


图 7-22 ”救援 担架 





图 7-23 ”救援 担架 实物 样机 
救援 担架 系统 分 为 内 层 与 外 层 两 个 组 成 部 分 ， 其 中 外 层 虚 拟 样 机 图 如 网 7-24 所 示 ， 起 到 
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破 障 、 文 撑 、 你 护 和 减 震 的 作用 ， 由 请 机 、 外 层 减 震 弹 千 、 外 圆 铝 较 及 上 日 平衡 系统 所 需 的 同 
步 市 等 部 件 组 成 ， 内 层 虚 拟 样机 图 和 实物 图 分 列 如 图 7-25 和 图 7-26 所 示 ， 主 要 由 内 层 铝 疼 、 
连接 村 、 内 层 减 震 弹 蛋 、 卡 强占、 般 门 和 担架 等 部 件 组 成 。 

为 保证 绳索 连接 可 靠 ， 在 救援 担架 内 层 中 设计 了 卡 强 各 结 构 ， 该 结构 具有 日 锁 特 性 ， 将 
配合 副 绳索 提 局 救援 平台 安全 性 ， 如 图 7-27 所 示 。 























图 7-24 ”救援 担架 外 层 虚 拟 样机 图 





图 7-26 ”救援 担 染 内 层 实物 图 图 7-27 卡 强占 


(2) 内 外 层 钢 圈 设计 “救援 担架 中 ， 内 外 层 钢 圈 不 但 是 连接 内 外 层 的 重要 结构 ， 也 是 自 
平衡 系统 中 保证 内 外 层 发 生 相 对 转动 的 装置 。 从 功能 上 来 说 ， 可 把 它 看 作 一 个 自制 的 大 轴承 。 
它 由 内 外 层 钢 圈 和 滚轮 组 成 ， 滚 轮 固定 在 外 层 钢 轿 上 ， 可 在 内 层 钢 圈 的 止 槽 里 滚动 。 按 原来 
设计 方案 ， 内 层 钢 圈 应 专门 设计 加 工 出 来 ， 但 由 于 加 工 难 度 大 和 费用 昂贵 的 原因 ， 直 接 采 用 
18in 的 自行 车 铝 合金 图 ， 直 径 420mm， 宽 度 30mm， 厚 度 20mm， 疾 上 还 带 一 个 阶梯 槽 ， 覃 深 
18mm， 壁 厚 2mm， 将 用 于 深 轮 的 深 动 模 。 由 于 自行 车 钢 圈 的 结构 特点 符合 功能 需求 ， 从 而 节 
省 了 加 工 步 又 ,省 去 了 大 部 分 加 工 费用 。 钻 孔 后 ， 通 过 螺栓 
螺母 与 其 他 部 件 连 接 。 救 援 舱 的 外 层 钢 圈 是 一 个 直径 为 
550mm， 宽 30mm， 厚 20mm 的 钢 圈 ， 同 样 考虑 到 加 工 难度 
大 和 费用 贵 的 原因 ， 直 接 采 用 22in 的 自行 车 铝 合金 圈 。 在 
铝 合金 图 壁 上 钻 孔 ， 通 过 世 形 铁 将 滚轮 固定 在 外 层 钢 轿 上 。 

(3) 滚轮 设计 ”滚轮 起 到 了 连接 、 文 撑 与 导 回 的 功能 。 

从 功能 上 看 其 实质 上 实现 的 即 是 轴承 的 功能 , 不 过 为 了 配合 钢 
疾 上 的 阶梯 槽 , 需要 对 深 轮 进行 专门 设计 , 滚轮 采用 尼龙 材料 ， 
中 心 镶 典 GB/T 276 一 1994 标准 轴承 。 图 7-28 为 滚轮 连接 内 外 7-28 ”滚轮 连接 内 外 圈 的 示意 图 
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图 的 示意 图 。 深 轮 的 虚拟 样机 图 、 实 物 图 和 工程 图 分 别 如 图 7-29 和 图 7-30 所 示 。 为 了 闭 配 便利 ， 
设计 出 轮轴 的 工程 图 如 图 7-31 所 示 。 





图 7-29 滚轮 
a) 滚轮 虚拟 样机 图 b) 滚轮 实物 图 





技术 要 求 ， 
1. 修 棱 、 去 毛刺 
6 2. 未 注 公 差 等 级 为 IT10 


图 7-30 ”滚轮 的 工程 图 


M6-6h 办 7-03 M6-6h 





技术 要 求 : 
1. 去 毛刺 
2. 未 注 公 差 等 级 为 IT10 


图 7-31 轮轴 的 工程 图 


(4) 担架 减 震 系统 设计 外 减 震 装置 安装 在 救生 舱 滑 权 上 ， 外 层 弹 费用 于 阻尼 高 频 震 动 ， 
因此 采用 了 直径 较 大 、 行 程 较 短 、 胡 死 系数 较 大 的 刚性 压 早 ， 通 过 人 字形 弹 敬 组 进行 减 震 ， 
结构 如 图 7-32 所 示 。 其 实物 图 如 图 7-33 所 示 。 


电 











图 7-32 ”外 层 人 字形 弹 竹 的 结构 图 7-33 ”人 字形 弹 竹 实物 图 


内 减 震 朔 置 安 朔 在 内 层 结构 上 ， 内 层 减 震 由 阻尼 相对 较 小 的 拉 策 组 成 ， 在 起 到 减 震 作用 
的 同时 也 可 用 来 连接 担 染 。 内 层 减 许 弹 申 的 结构 和 实物 图 如 图 7-34 和 图 7-35 所 示 。 


图 7-34 ”内 层 减 震 弹 和 偶 的 结构 
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图 7-35 ”内 层 减 震 弹 知 实 物 网 
7.3.4 ”上 自 平衡 控制 系统 


和 
圭 广 


救援 担架 系统 的 自 平 衡 系 统 由 内 外 层 钢 圈 、12W 直流 电动 机 、 同 步 带 、 电 动机 控制 电路 
部 分 组 成 。 自 平衡 系统 工作 流程 如 图 7-36 所 示 。 


Pe 
俯仰 角 平 衔 
图 7-36 “上 自 平衡 系统 工作 流程 
(1) 目 平 衡 系 统 工作 原理 ” 当 救 援 舱 在 山体 和 斜面 运行 时 ， 如 果 出 现 侧 癌 倾斜 ， 束 会 使 救援 舱 
的 内 层 翻 深 。 目 平衡 系统 通过 水 平 传 感 占 实时 监测 救援 舱 横 和 癌 的 水 平 状态 ，A/D 采样 间隔 为 0.2s。 
当 转 动 角 上 度 超 过 10” ， 即 传感器 输出 的 电压 超过 所 设 定 的 国 值 ， 电 动机 起 动 带动 同步 带 使 救援 舱 


内 层 相 对 于 外 层 转 动 ， 使 内 层 总 是 你 持 在 水 平 状 态 ， 直 全 救援 舱 的 水 平 倾斜 角度 小 于 5”， 系 统 
会 停止 电动 机 的 调整 进入 监测 状态 。 目 平衡 系统 便 件 电路 图 如 图 7-37 所 示 。 
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图 7-37 
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自 平衡 系统 便 件 电路 图 
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自 平衡 系统 驱动 电动 机 通过 电动 机 支 座 安装 在 救援 舱 的 内 层 结 构 上 。 选 用 的 电动 机 工作 
电压 为 12V， 额 定 功 率 15W， 减 速 比 30， 输 出 转速 为 90r/min， 最 大 转 夫 SN，m。 图 7-38 为 
自 平衡 系统 驱动 传动 系统 ， 图 7-39 为 电动 机 安装 后 的 效果 图 。 

电动 机 的 输出 轴 上 安装 有 宽度 10mm、 模 数 4、 直 径 60omm、 具 数 15 的 直 齿 圆柱 齿轮 ， 与 
直径 为 600mm、 模 数 为 4、150 齿 的 直 齿 圆柱 齿轮 内 吐 合 。 两 者 之 间 的 传动 比 为 1:10。 电 动机 
通过 齿轮 咕 合 带动 救援 舱 的 内 层 相 对 于 救援 舱 的 外 层 旋 转 。 
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\ SS 一 
图 7-38 日 平衡 系统 驱动 传动 系统 图 7-39 ”电动 机 安装 后 的 效果 图 
(2) 深 转 角 调节 子 系统 ”在 救援 过 程 中 ， 如 果 救 援 担 架 外 层 发 生 深 动 ， 深 转角 调节 系统 


工作 ， 保 证 伤员 始终 面部 问 上 丹 在 救援 担架 中 ， 不 会 及 生 从 担 染 上 跌落 的 事故 。 在 虚拟 样机 
和 实物 中 ， 深 转角 调 市 担 染 工作 过 程 分 别 如 图 7-40 和 图 7-41 所 示 。 














a) b) 
图 7-40 ” 深 转 角 调 节 担 架 工 作 过 程 示 意 ( 虚 拟 样机 ) 
a) 角度 一 b) 角度 二 





a) b) 
图 7-41 深 转 角 调节 担架 工作 过 程 (实物 图 ) 
a) 角度 一 b) 角度 二 
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(3) 俯仰 角 调 市 子 系统 ”救援 舱 发 生 倾 冬 ， 信 仰角 系统 对 信仰 角 进 行 调 证 ， 保 证 伤员 在 
救援 舱 中 保持 平 腾 状态 ， 在 救援 过 程 中 稳定 伤势 ， 避 人 钢 二 次 伤害 。 图 7-42 所 示 为 信仰 角 调 市 
机 构 工 作 过 程 示 总 图。 在 虚拟 样机 和 实物 中 ， 俯 仰角 调 市 机 构 工 作 过 程 示意 图 分 别 如 图 7-43 
和 图 7-44 所 示 。 








a) b) 


图 7-42 ”俯仰 角 调 市 机 构 工作 过 程 示意 图 


a) 位 置 一 b) 位 置 二 





a) b) 
图 7-43 ”俯仰 角 调节 机 构 工 作 过 程 示意 图 (虚拟 样机 ) 


a 似 于 二 站) -位置 二 





a) b) 
图 7-44 ”俯仰 角 调节 机 构 工 作 过 程 示 意图 (实物 图 ) 
a) 位 置 一 b) 位 置 二 
俯仰 角 调 节 子 系统 中 运动 的 传递 为 旋转 一 直线 一 旋转 ， 采 用 曲柄 滑 块 机 构 实现 运动 的 传 
递 ， 曲 柄 清 块 机 构 简 图 如 图 7-45 所 示 。 
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为 安 钱 曲柄 滑 块 机 构 ， 在 救援 担架 内 层 构造 出 一 个 长 80cm、 宽 30cm、 高 30cm 的 平台 ， 
将 铁杆 焊接 搭 成 长 方 体 篮 子 状 ， 曲 柄 请 块 机 构 便 安 闭 在 此 铁 篮 子 上 。 其 中 俩 心 距 e=8cm， 等 
效 连 杆 上 =$8cm， 连 杆 运动 角度 〈 相 对 于 水 平 位 置 ) 范围 从 -10” 到 20”， 通 过 作 图 法 可 确定 
出 曲柄 [=28cm,， 滑 块 行程 三 25， 即 传动 机 构 丝 杠 的 最 小 长 度 应 为 25cm。 选 用 步 进 电动 机 作 
为 从 仰角 调和 系统 的 动力 源 ， 通 过 受 力 分 机 ， 选 用 57BYG250 一 56 型 与 的 步 进 电动 机 ， 其 相 
数 为 2， 静 转 矩 为 0.9N。m。 传 动机 构 中 选用 头 数 4、 直径 为 gmm、 长 为 300mm 的 丝 杠 。 














图 7-45 ”曲柄 清 块 机 构 简 图 


主要 创新 点 及 取得 的 成 果 


7.4.1 “作品 主要 创新 点 


作品 的 主要 创新 点 如 下 : 

1) 针对 边缘 救援 复杂 的 地 形 环 境 ， 采 用 角度 和 长 度 均 可 调整 的 三 脚 典 作为 救援 朔 置 的 文 
返回 定 装置 ， 以 保证 整套 装置 在 复杂 地 形 中 实现 可 靠 的 固定 连接 。 

2) 两 套 动 力 源 ， 通 过 两 套 动 力 源 的 切换 ， 你 证 整套 装置 在 施 救 过 程 中 能 有 可 苇 的 动力 
来 源 。 

3) 一 套 主 绳 实施 拖 搜 ， 两 套 副 绳 一 方面 在 主 绳 失效 的 情况 下 ， 通 过 救援 担架 壳 体 上 装 有 
的 卡 绳 右 ， 使 救援 担架 系统 牢固 地 与 副 绳 连接 ， 起 到 保护 作用 ， 态 一 方面 两 套 副 绳 在 主 绳 将 
救援 担架 系统 癌 上 拖 搜 过 程 中 起 到 导 癌 、 定 位 作用 。 

4) 救援 担架 过 体 外 形 采 用 流线型 设计 ， 主 体 呈 柱 形 ， 尖 部 为 锥 形 。 利 用 合理 的 外 形 设 计 
减 小 担架 拖 搜 前 进 中 的 阻力 ， 并 具有 一 定 的 破 障 和 越 障 能 力 。 

5) 救援 担架 系统 采用 电动 机 控制 的 日 平衡 系统 来 实现 目 动 调节 ， 保 证 担架 在 滚 园 角 和 念 
仰角 两 个 维度 上 总 保持 相对 水 平 ， 减 少 施 救 过 程 中 对 伤 者 可 能 造成 的 二 次 伤害 。 

6) 救援 担架 系统 采用 人 字形 弹 旨 和 橡胶 减 震 吉 两 层 减 晨 猴 置 , 具有 民 好 减 震 和 绥 冲 效果 。 


7.4.2 ”作品 取得 的 成 果 
作品 取得 的 成 果 如 下 : 
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大 学 生 课 外 科技 创新 竞赛 获奖 作品 精 析 


1) 边缘 救援 平台 实物 样机 1 台 。 

2) 边缘 救援 平台 研究 报告 1 份 。 

3) 天 疾 。 

Q 第 五 届 首 都 高 校 大 学 生机 械 设 计 创 新 大 赛 一 等 奖 。 
@ 第 四 届 全 国 大 学 生机 械 创 新 设计 大 赛 一 等 奖 。 


已 结 与 展望 


边缘 救援 平台 是 在 现 有 救援 三 脚 典 基础 上 搭建 的 一 黎 专 业 救 援 平 台 ， 通 过 机 电 一 体 化 议 
计 ， 旨 在 适应 山体 复杂 地 形 条 件 ， 克 服 地 形 崎 虹 、 救 援 困 难 等 情况 ， 减 少 被 施 救 者 在 接受 救 
援 过 程 中 的 三 次 损伤 ， 快 速 而 安全 地 将 伤 者 救出 险 地 。 

作品 由 拖 搜 系统 和 救援 担 染 系统 两 部 分 组 成 。 拖 搜 系 统 由 三 脚 架 、 绞 盘 、 钢 丝 强 和 动力 
系统 组 成 。 其 中 可 灵活 调 市 的 三 脚 染 能 适应 复杂 的 是 边 地 形 而 起 到 有 效 的 文 撑 作用 ;绞盘 、 
钢丝 强 和 动力 系统 有 机 结合 ， 可 实现 救援 担 染 系统 的 可 徘 收 放 ; 钢丝 绳 分 主 副 两 套 ， 主 绳 起 
主要 拖 动 作用 ， 副 强 主 要 是 在 主 绳 失效 的 情况 下 起 你 护 蕉 代 作 用 ， 同 时 义 有 一 定 的 叶 辣 、 害 
位 功能 。 救 援 担架 系统 由 担 录 及 其 外 部 起 保护 作用 的 元 体 结 构 组 成 。 流 线 型 的 元 体 结构 能 
效 殴 服 复 杂 地 形 的 不 利 影响 。 其 目 融 一 套 控制 系统 和 减 震 装置 ， 以 保证 被 施 救 者 在 上 升 过 程 
中 相对 平稳 ， 使 伤 者 避免 受到 二 次 伤害 。 

作品 在 设计 过 程 中 充分 郑 夸 山体 边缘 地 市 的 地 形 及 被 施 救 者 的 受伤 情况 ， 充 满 人 性 化 设 
计 ， 是 一 于 安全 、 可 靠 、 局 效 的 专业 救援 作品 。 本 作品 的 研制 成 功 将 为 边缘 救援 领域 救援 设 
备 开发 设计 提供 新 的 设计 思路 和 技术 方 同 ， 拓 局 救援 效 京 ， 为 被 救 伤 员 抢 得 宝 贯 的 救治 时 间 ， 
同时 将 降低 救援 人 员 开 展 工作 时 操作 救援 设备 的 难度 和 复杂 程度 。 
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第 8 章 干 足 虫 宠物 机 器 人 
(首都 高 校 第 去 局 机 械 创新 设计 大 赛 一 等 奖 ，2012 年 ) 


EN 作品 研究 9 育 景 及 意义 


针对 目前 仿生 机 械 娱 乐 产 品 所 存在 的 不 足 ， 项 目 组 在 仿生 学 研究 的 基础 上 ， 将 轮 式 机 可 
人 运动 速度 快 和 腿 式 机 器 人 地 形 适 应 能 力 强 的 优点 相 结合 ， 设 计 并 研制 了 千足 虫 龙 物 机 器 人 。 
千足 虫 宠 物 机 器 人 只 有 体积 小 ， 运 动 方式 灵活 多 杰 ， 地 形 适 应 能 力 强 ， 控 制 方便 等 优点 ， 独 
特 的 腰部 结构 设计 ， 使 其 运动 更 加 丈 活 ， 姿 态 展示 更 加 丰富 ， 是 一 亚 非 常 优秀 的 局 科技 娱乐 
蔓 稍 宠物 玩具 。 干 中 虫 宠物 机 旨 人 的 研制 成 功 对 于 丰 蝇 家 姓 机 械 玩 具 种 类 及 提 蜗 我 国 仿生 机 
械 娱 乐 产 品 的 研发 水 平 具 有 重要 音义。 


作品 概述 














8.2.1 ”研究 内 容 概述 


千足 虫 宠物 机 器 人 是 在 仿生 研究 的 基础 上， 将 轮 式 机 器 人 运动 速度 快 和 腿 式 机 器 人 地 形 
适应 能 力 强 的 优点 相 结合 ， 设 计 得 到 的 一 款 可 以 实现 多 体 节 模 块 化 组 合 的 链 节 式 机 械 娱乐 产 
品 。 该 作品 的 主要 研究 内 容 包 括 机 械 结 构 设计 、 运 动 仿 真 及 步 态 设计 和 控制 系统 设计 。 


1. 机 械 结构 设计 

干 足 虫 宠物 机 旨 人 的 整体 结构 包含 4 个 模块 ， 每 个 模块 主要 由 轮 腿 式 运动 足 、 模 其 化 连 
接 板 和 腰部 链 节 结构 组 成 。 每 个 运动 足 由 四 个 关节 和 一 个 轮 足 组 成 ， 共 有 五 个 主动 目 由 度 ， 
两 个 对 称 布置 的 运动 足 通过 模块 化 连接 板 连 接 组 成 一 个 体 厂 ， 各 体 之 间 通 过 链 世 式 腰 部 关 
节 连 接 ， 形 成 一 个 具有 十 二 个 目 由 度 的 模块 ， 每 个 目 由 度 由 舵 机 或 直流电 动机 张 动 。 因 此 该 
部 分 主要 研究 轮 腿 式 运 动 足 、 模 块 化 连接 板 和 腰部 的 结构 造型 与 仿真 ， 以 结构 紧凑 、 强 度 足 
够 、 运 动 姑 活 为 设计 原则 。 

2. 运动 仿真 及 步 态 设计 

步 态 设计 是 千足 虫 宠 物 机 问 人 拥有 机 动 灵活 运动 特性 的 基础 ， 运 动 仿 芮 可 为 干 足 虫 老 
物 机 器 人 实物 样机 的 研制 真 定 坚 实 的 理论 基础 。 在 八 足 形式 下 ,千足 虫 宠 物 机 器 人 共有 46 
个 目 由 度 ， 采 用 对 每 一 个 目 由 度 进 行 编号 的 方法 ， 通 过 建立 各 时 刻 不 同 位 置 处 电动 机 的 角 
位 移 数 据 表 ， 对 其 进行 运动 仿真 ， 并 充分 结合 目 然 界 中 各 种 生物 的 运动 方式 ， 设 计 多 种 运 
动 步 态 。 

3. 控制 系统 设计 

控制 系统 是 千足 虫 宠 物 机 右 人 有 具备 高 性 能 运动 能 力 的 可 靠 你 证 。 整 个 控制 系统 主要 包 
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括 控 制 模块 、 电 源 管 理 模 其 、 电 动机 驱动 模块 、 通 信和 模块 、 传 感 检测 模块 及 电动 机 执行 模 
块 。 为 实现 对 多 个 电动 机 的 协调 控制 ， 采 用 分 层 递 阶 式 的 控制 系统 体系 结构 ， 并 采用 遥控 
与 目 主 控制 相 结合 的 控制 方式 。 采 用 多 轴 伺 服 运动 控制 技术 ， 实 现 控制 方式 的 多 层次 模块 
化 管理 。 


8.2.2 ”技术 指标 


1) 外 形 尺 寸 : 长 三 0.8m， 宽 三 0.3m， 高 二 0.2m， 整 机 总 重 三 10kg。 

2) 平均 巡航 速度 为 40m/min， 最 大 巡航 速度 为 60m/min， 攀 和 仆 障 人 碍 最 大 高 度 为 0.15m。 

3) 机 器 人 腰部 结构 可 带动 相 邻 两 体 节 作 左右 及 上 下 方向 转动 ， 左 右 方向 的 转动 范围 不 小 
于 -30° 一 +30” ， 上 下 方 癌 的 转动 范围 不 小 于 -30” 一 +45” 。 

4) 机 器 人 可 模拟 昆虫 、 机 动车 等 多 种 姿势 行进 ， 实 现 昆虫 多 足 爬 行 、 蟒 蟹 横 问 侧 行 、 几 
式 需 蜀 表 进 、 机 车 轮 式 滚动 和 绕 点 回旋 转动 等 多 种 步 态 。 

5) 控制 系统 可 对 46 个 电动 机 进行 稳定 的 控制 ， 能 够 根据 地 形变 化 改变 运动 控制 策略 ， 
合理 实现 各 种 步 态 之 间 的 切换 。 

6) 携 融 多 种 高 性 能 传 感 探 测 设备 ， 实 现 对 工作 环境 信息 的 有 效 采 集 。 


天 键 近 术 


8.3.1 机械 结构 设计 


1. 机 械 结 构 总 体 设 计 框 图 

千足 虫 宠物 机 器 人 的 机 械 结 构 采 用 模块 化 思想 进行 设计 ， 整 体 结构 包含 4 个 模块 ， 每 个 
模块 主要 由 三 个 部 分 组 成 : 轮 腿 式 运动 足 、 膀 部 链 节 结构 和 模块 化 连接 板 。 机 械 结 构 的 总 体 
设计 框图 如 图 8-1 所 示 。 


















































各 关节 连接 辟 设 计 


人 大和] 个 
轮 足 的 运动 足 


2 个 运动 足 1 块 
关 市 板 的 模块 
千足 中 机 械 宠物 
的 完整 机 械 结构 


图 8-1 机 械 结 构 的 总 体 设 计 框 图 


轮 式 足 半径 弧度 设计 











模块 快速 连接 设计 | ”| 转向 机 构 设 计 















2、， 轮 腿 式 运动 足 的 设计 
腿 部 是 千足 虫 宠物 机 器 人 运动 的 关键 环节 ， 是 多 种 步 态 得 以 实现 的 基础 。 为 了 让 干 足下 
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宠物 机 器 人 运动 地 更 灵活 ， 实 现 多 种 行走 方式 ， 首 先 对 其 腿 部 进行 结构 设计 。 

(1) 腿 部 设计 目标 

1) 运动 灵活 ， 能 够 适应 多 种 地 形 ， 可 以 在 以 艇 关节 为 中 心 的 6120 球面 与 89150 球面 之 间 
的 任意 区 域 洲 地 。 

2) 结构 紧凑 ， 空 间 利用 率 高 ， 便 于 实现 机 堪 人 的 小 型 化 、 娱 乐 化 。 单 腿 占 用 罕 间 <150mmx 
240mmx80mm， 单 腿 质量 <1kg。 

3) 强度 及 动力 足够 ， 保 证 正常 行走 时 不 会 出 现 强度 问题 ， 对 于 突 发 情况 有 一 定 耐 受 力 。 

4) 运动 时 前 后 两 体 节 、 两 腿 之 间 及 腿 与 板 之 间 不 发 生 运动 干涉 。 

(2) 设计 方案 就 目前 已 有 的 各 种 仿生 机 器 人 运动 足 的 设计 而 言 ， 腿 式 机 器 人 具有 地 形 
适应 性 强 的 优点 ， 但 存在 运动 速度 慢 、 机 体 平 衡 控制 困难 等 不 足 ， 轮 式 机 峰 人 运动 速度 快 ， 
但 跨越 障碍 、 适 应 不 同 地 形 和 机 喘 灵 活 运动 的 能 力 稍 有 欠缺。 

结合 设计 目标 和 以 上 分 析 ， 提 出 以 下 设计 方案 : 在 保留 机 器 人 本 和 映 的 轮 式 运动 的 同时 ， 
结合 生物 腿 式 运动 的 特点 ， 设 计 一 于 既 具 有 和 轮 式 的 运动 速度 快 又 具有 腿 式 的 地 形 适 应 性 强 特 
点 的 千足 虫 宠 物 机 器 人 ， 即 腿 部 的 结构 形式 采用 轮 腿 复合 式 设 计 方 案 。 

(3) 腿 部 整体 结构 “于 足 虫 宠物 机 器 人 的 腿 部 整体 结构 如 图 8-2 所 示 。 腿 部 由 4 个 转动 
天 方 、1 个 作为 足 部 的 直流 电动 机 和 具有 特定 角度 的 曲 辟 结 构 组 成 。 每 条 腿 具 有 5 个 日 由 虑 ， 
分 别 由 4 个 直流 角 位 移 伺服 电动 机 和 1 个 直流 电动 机 驱动 实现 。 通 过 对 电动 机 的 精确 控制 可 
使 机 器 人 通 真 、 流 畅 地 展现 各 种 预 设 步 态 。 
































图 8-2 腿 部 整体 结构 图 
4 个 腿 部 转动 关节 可 实现 180” 大 范围 的 转动 ， 用 来 改变 腿 部 运动 结构 ， 实 现 各 种 造型 。 
足 部 的 直流 有 刷 电 动机 用 来 弓 动 负载 小 轮 ， 可 以 使 机 体 以 轮 式 浚 动 的 方式 快速 移动 。 
以 千足 中 宠 物 机 颖 人 整体 癌 前 方 癌 为 和 轴 ,， 侧 问 为 了 轴 ， 竖 直方 癌 为 Z 轴 ， 建 立 如 图 8-2 
所 示 的 空间 直角 坐标 系 。 王 足 虫 宠物 机 器 人 的 具体 运动 方式 可 摘 述 为 : 


电 
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1) 悄 部 电动 机 了 轴 方 回 的 转动 通过 锥 齿轮 转化 为 Z 轴 方 回 的 转动 ， 带 动 整 条 腿 绕 Z 轴 方 
器 旋转。 

2) 散 关 方 上 电动 机 闻 轴 方 回 的 转动 通过 曲 医 结构 带动 腿 部 上 下 运动 。 

3) 膝 关 节 上 电动 机 丈 轴 方 癌 的 转动 带动 足 部 实现 了 2 平面 上 的 转动 。 

4) 中 关节 上 电动 机 Z 轴 方 癌 的 转动 市 动 足 部 实现 Y7 水 平面 上 的 转动 。 

5) 下 部 的 直流 电动 机 了 轴 方 癌 的 转动 珊 动 轮子 实现 轮 式 滚动 。 

(4) 具体 介绍 

1) 悄 部 。 和 干 足 虫 宠物 机 器 人 的 屑 部 设计 如 图 8-3 所 示 。 采 用 辉 感 MG995 直流 角 位 移 
伺服 电动 机 提供 动力 ， 通 过 两 个 模 数 为 1， 齿 数 为 20 的 锥 齿轮 ， 传动 比 为 1， 将 电动 机 了 
轴 方 问 的 转动 转化 为 Z 轴 方 同 的 转动 。 由 腿 轴 融 动 整 条 腿 进 行 绕 Z 轴 的 转动 ， 转 角 范 围 
为 -90" 一 90” 

腿 轴 由 上 部 齿轮 箱 上 的 轴承 与 板 上 轴承 进行 固定， 其 上 齿轮 通过 键 进行 国定 。 腿 轴 与 腿 
部 通过 型 耐 联接 进行 周 问 固定 ， 通 过 螺母 进行 轴 问 固定 。 腿 轴 分 解 图 如 图 8-4 所 示 。 











图 8-3 ” 肩 部 示意 图 图 8-4 ” 腿 轴 分 解 图 


2) 髋 关节 。 艇 关节 主要 用 于 实现 整 条 腿 在 到 平面 内 的 转动 ， 考 虑 干涉 情况 后 ， 将 其 转 
角 范 围 确定 为 15° 一 165"” 。 

根据 该 关节 所 受 最 大 力矩 ， 选 用 XQ 一 S4230D 直流 角 位 移 伺服 电动 机 作为 动力 单元 ， 该 
电动 机 的 外 形 尺 寸 为 40.2mmx20.1mmx38.8mm。 对 伺服 电动 机 采用 包围 结构 ， 根 据 伺 服 电动 
机 的 尺寸 来 确定 包围 结构 外 壳 的 尺寸 ， 并 通过 精细 的 测量 来 确定 背 板 上 和 伺服 电动 机 对 称 位 
置 安装 轴 的 位 置 ， 从 而 保证 对 称 性 。 此 外 ， 在 设计 时 ， 两 侧 预 留 出 了 0.1mm 的 安装 间 阶 以 方 
便 调整 。 图 8-5 为 髋 关节 的 结构 分 解 图 。 





图 8-5 通关 克 的 结构 分 解 图 








3) 腿 部 曲 臂 。 为 了 使 腿 部 关节 有 更 大 的 活动 范围 ， 需 要 对 连接 件 进行 一 定 的 设计 ， 使 运 
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动 干涉 情况 最 少 。 通 过 对 运动 足 动 作 的 设计 要 求 进行 分 析 可 知 ， 曲 臂 应 由 两 部 分 组 成 ， 并 且 
要 求 前 部 长 度 >32mm， 后 部 长 度 >30mm， 两 轴 之 间 的 距离 >60mm。 通 过 调整 尺寸 ， 确 定 抛 角 
为 90”， 前 部 长 度 为 35mm， 后 部 长 度 为 52mm。 

曲 臂 尺寸 几何 关系 如 图 8-6 所 示 。 设 前 部 长 度 为 w&， 后 部 长 度 为 2， 两 轴 距 离 为 c， 由 勾 
股 定理 可 得 ，c=62.3>60， 因 此 设计 合理 。 

所 设计 的 曲 臂 结构 如 网 8-7 所 示 。 








a >32 
Nm 
= * 
oy , ?49.44mm 2 , 
-By 
> 
c>60 a 
Fr 一 少 
图 8-6 ， 曲 臂 尺寸 几何 关系 图 图 8-7 曲 臂 结构 





两 曲 化 之 间 的 设计 间距 为 49.44mm， 通 过 一 块 横 板 将 两 曲 臂 连接 为 一 整体 ， 使 其 共同 运 
动 ， 市 动 下 部 结构 。 

4) 膝 着 与 踩 天 。 为 了 而 省 空间 ， 将 膝 关 节 与 踩 天 设计 为 一 个 整体 ， 上 部 分 与 曲 辟 
进行 连接 ， 市 动 下 部 及 足 部 在 开平 务 进 行 旋转 ， 考 虑 干涉 问题 ， 将 膝 关 市 的 转角 范围 确定 为 
15” 一 165”。 与 通关 和 共同 作用 ， 使 得 机 堪 人 足 部 的 可 达 范 围 更 加 宽广 。 

下 部 踩 关 节 主 要 带动 足 部 经 Z 轴 进 行 旋转 ， 转 动 范 围 为 -90"” 一 90” ， 可 以 使 足 部 癌 前 或 
问 后 运动 ， 实 现 更 多 步 态 。 

两 部 分 依旧 采用 包 转 此 机 的 结构 ， 如 图 8-8 和 图 8-9 所 示 。 通 过 三 层 板 登 加 回 定 ， 并 共 
用 一 其 分 隅 板 ， 以 减少 重量 。 





























图 8-8” 骨 机 包围 结构 图 图 8-9 ” 骨 机 包围 侧 视 图 
5) 足 部 。 千 足 虫 老 物 机 器 人 的 足 部 是 其 运动 的 基础 ， 是 其 轮 陈 行走 及 腿 式 行走 的 看 地 点 。 
依据 MAXON 直流 电动 机 的 形状 ， 采 用 包 禾 式 的 形式 设计 出 长 柱 型 的 中 部 ， 如 图 8-10 所 示 。 
以 育 洲 电动 机 作为 是 部 的 主体 ， 前 端 狠 有 轮子 ， 可 实现 轮 式 行走 ， 后 端 在 腿 式 行走 时 可 以 作 
为 下 部 。 
关于 轮子 形状 的 设计 ， 由 于 足 部 需要 绕 图 8-11 所 示 圆 心 进行 旋转 ， 为 了 使 干 足 虫 宠 物 机 


@ 




















第 8 章 干 足 虫 宠物 机 器 人 








骼 人 平稳 接触 地 面 ， 需 要 你 证 轮子 曲线 与 独 示 大 圆 相 切 ， 这 样 才 能 你 证 转动 平稳 。 该 大 圆 的 
圆心 即 为 曲 臂 与 膝 关 节 的 连接 处 ， 直 径 为 111mm。 轮 子 曲线 与 这 个 圆 相 切 ， 然 后 以 圆 弧 向 中 
心 过 渡 。 此 外 ， 由 于 大 多 数 时 间 轮 子 如 图 8-11 所 示 状 态 进行 转动 ， 为 了 增 大 其 与 地 面 的 接触 
面积 ， 设 置 了 一 道 鹤 面 宽度 为 4.66mm 的 平面 ， 可 避免 轮子 因 压强 太 大 而 损坏 。 














图 8-10 足 部 设计 图 图 8-11 运动 足 圆 域 图 
由 于 轮子 最 宽 处 的 直径 为 69mm， 周 长 为 216.66mm， 选 用 的 直流 电动 机 在 24V 的 电压 下 
转速 为 S$0rmin， 王 和 足 虫 宠物 机 器 人 的 巡航 速度 可 达 2m/s。 
图 8-12 所 示 为 轮 足 分 解 岁 。 在 轮子 的 固定 方式 上 上， 首先 将 辊 了 固定 在 轮 必 上 ， 通 过 长 方 
形 的 键 进行 周 问 固定 ， 通 过 螺钉 进行 轴 问 固定， 然后 将 轮 必 通过 D 形 孔 固定 在 电动 机 延伸 套 
上 ， 了 最 后 将 电动 机 延伸 套 通 过 轴承 进行 轴 回 及 周 同 固定 ， 使 得 轮子 不 容易 脱 沙 抒 出 。 

















图 8-12” 轮 足 分 解 图 
对 于 直流 电动 机 和 轮 足 后 部 橡胶 脚 热 的 固定 ， 直 流 电 动机 通过 螺钉 固定 在 脚 部 外 壳 上 ， 














后 部 通过 插 板 进一步 限制 其 轴 癌 运动 ， 分 担 一 部 分 步行 姿态 造成 的 冲击 力 : 脚 后 部 的 橡胶 脚 
垫 通 过 卡 短 回 定 在 足 部 外 郝 上 ， 起 到 缓冲 作用 ， 避 免 神 击 过 大 ， 损 坏 机 二 人 。 

3. 腰部 链 市 结构 设计 

(1) 腰部 设计 目标 ， 腰 部 机 构 应 具有 多 个 目 由 度 ， 以 使 生 足 虫 龙 物 机 器 人 只 有 多 样 化 的 
步 态 ， 姿 势 更 加 生动 灵活 ， 有 具有 更 加 接近 于 真实 动物 的 运动 特点 。 

腰部 结构 以 艇 机 作为 原 动 机 ， 带 动 相 邻 两 体 市 作 左 右 及 上 下 方 癌 转动 ， 其 中 左右 方 癌 的 
转动 范围 不 小 于 -30"” 一 +30”， 上 下 方向 的 转动 范围 不 小 于 -30° ~+45°。 

在 完成 部 分 预 设 姿 势 时 ， 单 一 体 节 造成 的 重量 和 力 窃 需要 全 部 由 上 下 方 回 转动 组 件 承 
担 。 根 据 目前 设计 的 腿 部 、 身 板 目 重 佑 算 ， 上 下 转动 方 问 转动 组 件 承 受 的 重力 大 于 20N， 捏 
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算 大 于 3N。m。 

左右 方 回 转动 组 件 在 千足 虫 宠物 机 器 人 水 平 运动 过 程 中 起 辅助 作用 ， 有 基体 需要 的 扭矩 很 
大 程度 上 受 腿 部 动作 的 影响 。 在 完成 特定 动作 时 ， 会 受到 单个 其 至 多 个 体 节 造成 的 重量 和 力 
矩 ， 知 以 2 节 体 节 计 算 ， 在 极限 姿态 下 ， 组 件 承受 的 重力 大 于 40N， 扭 矩 大 于 3N。m。 

(2) 腰部 结构 设计 根据 设计 要 求 ， 腰 部 结构 分 为 两 大 部 分 ， 左右 方向 转动 组 件 和 上 下 
方向 转动 组 件 。 左 右 方 癌 转动 组 件 通 过 其 中 的 腰 左 右 方 向 连 接 件 与 后 一 体 节 相连 :上 下 方 辐 
转动 组 件 通 过 其 中 的 腰 上 下 方 癌 连接 件 与 前 一 体 丰 相连 :两 体 和 之 间 通 过 上 下 方 同 腰椎 和 磊 
右 方向 腰椎 相连 ， 形 成 类 似 十 字 节 的 结构 。 两 组 件 分开 有 利于 设计 过 程 中 前 后 两 体 节 相 对 位 
置 的 调整 ， 也 有 利于 俐 化 工艺 。 在 考虑 腰部 结构 的 大 小 时 ， 参 考 了 强度 要 求 。 

由 于 骨 机 本 生 材 料 强 度 所 限 ， 以 上 两 组 件 的 重量 由 其 他 机 构 承 担 。 骨 机 仪 提供 所 需 力 
逢 。 综 合 考 虑 功 识 、 输 出 力 窍 、 响 应 时 间 、 转 动 角 度 纬 和 价格 每 因素 ， 选 择 的 舱 机 型 号 
见 表 8-1。 






































表 8-1 腰部 航 机 型 号 





左右 方向 | XQ 一 S4230D 210 40.2 38.8 20 
上 下 方 和 同 | HS 一 7980TH 180 22 4 30 





腰部 总 体 结构 如 图 8-13 所 示 。 上 腰部 左右 方 回 转动 组 件 和 上 下 方 同 转动 组 件 的 结构 如 图 
8-14 所 示 。 腰 部 所 包含 的 零件 见 表 8-2。 





a) b) 


图 8-14 ”腰部 左右 方向 转动 组 件 与 上 下 方向 转动 组 件 结构 图 
a) 左右 转动 组 件 b) 上 下 转动 组 件 
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表 8-2 ”腰部 零件 
腰 轴 
腰 左 右 转动 件 
腰 左 右 连 接 件 
腰 左 右 腰 椎 
左右 方向 转动 组 件 腰 轴 盖 
舵 机 
腰 左 右 舵 机 固定 架 
轴承 
直 齿 轮 
腰 轴 
腰 上 下 转动 件 
腰 上 下 连接 件 
腰 上 下 腰椎 
上 下 方向 转动 组 件 腰 轴 盖 
艇 机 
腰 上 下 能 机 固定 架 
轴承 
直 齿 轮 


(3) 腰部 轴 系 的 设计 ”由 于 腰部 左右 方 回 转动 组 件 与 上 下 方 回 转动 组 件 结构 相近 ， 为 了 
提高 系统 的 重复 利用 率 ， 两 组 件 使 用 相同 的 腰 轴 、 轴 天 、 轴 承 兰 、 丙 轮 ， 相 应 地 ， 腰 上 下 转 
动 件 与 腰 左 右 转动 件 、 上 下 方向 腰椎 与 左右 方 问 腰椎 在 轴 癌 尺寸 上 完全 一 致 。 

腰椎 结构 如 图 8-15 所 示 。 受 力 分 析 如 下 : 

为 确保 零件 结构 强度 满足 要 求 , 在 Creo Simulate 1.0 中 对 零件 进行 了 受 力 分 析 。 和 干 吓 虫 宠 
物 机 器 人 动作 多 样 ， 为 了 便于 受 力 分 析 ， 对 其 进行 了 一 定 的 简化 ， 作 如 下 假设 : 干 足 虫 宠物 
机 器 人 处 于 议 态 、 单 体 广 巷 空 状态 ， 并 且 单 体 市 所 受 重 力 全 部 由 腰部 承担 。 

通过 分 析 、 计 算 及 实物 测量 ， 在 未 加 电路 、 装 饰物 的 情况 下 ， 得 到 的 单 体 节 的 质量 为 
1.8Kg。 为 保证 在 安装 好 附加 物 之 后 的 强度 ， 留 一 定 余 量 ， 假 设 单 体 市 所 受 重 力 为 20N。 以 下 
为 各 个 零件 的 受 力 分 析 条 件 及 给 

1) 腰 上 下 转动 件 。 零 件 受 力 情 况 如 图 8-16 所 示 。 箭 头 代 表 体 节 对 其 施加 的 压力 ， 总 和 
为 20N， 假 设 力 均匀 分 布 。 零 件 材 质 为 馈 。 受 力 结果 分 析 图 如 图 8-17 所 示 。 
































图 8-15 ”腰椎 结构 示意 图 图 8-16 腰 上 下 转动 件 的 受 力 情况 
铝 的 屈服 强度 为 15~~20MPa， 由 图 8-17 可 以 看 出 ， 除 螺纹 孔 极 小 区 域 压 强 约 为 19MPa 
外 ， 其 余地 方 都 远 小 于 铝 的 屈服 强度 ， 因 此 腰 上 下 转动 件 的 强度 符合 设计 要 求 。 
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由 于 零件 受 力 情 况 复 杂 ， 下 面 从 妃 一 个 方 癌 研究 其 受 力 情况 ， 如 图 8-18 所 示 。 同 样 ， 往 
头 代 表 体 和 对 其 施加 由 压力 ， 总 和 为 20N， 并 假设 力 的 分 布 艾 飞 。 赂 中 还 标记 出 了 与 相 邻 零 
件 固定 用 了 扎 ， 这 里 将 其 设 定 为 固定 面 。 去 件 材质 为 铝 。 























8-17 有 腰 上 下 转动 件 受 力 结果 分 析 图 8-18 有 腰 上 下 转动 件 二 次 受 力 示 意图 
腰 上 下 转动 件 二 次 受 力 结果 分 析 图 如 图 8-19 所 示 。 从 图 8-19 可 以 看 出 ， 只 有 固定 用 也 
处 出 现 了 较 小 的 峰值 ， 其 他 地 方 均 满 足 强度 要 求 。 














8-19 ” 腰 上 下 转动 件 二 次 受 力 结果 分 析 图 
2) 腰 左 右 转 动 件 及 腰 轴 。 此 组 件 中 ， 腰 左右 转动 件 材料 为 铝 ， 腰 轴 材 料 为 Fe40。 受 力 分 
析 结 果 分 别 如 图 8-20 和 图 8-21 所 示 。 所 施加 的 力 分 为 两 组 ， 上 边 一 组 大 小 为 28.3N， 下 边 一 
组 大 小 为 20N。 图 上 所 示 的 4 个 孔 为 与 相 邻 零件 固定 用 孔 ， 这 里 将 其 设 定 为 固定 面 。 从 图 中 
可 以 看 出 ， 左 右 转 动 件 及 腰 轴 均 满 足 强 上 度 要 求 。 
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8-20” 腰 左右 转动 件 受 力 结果 分 析 图 8-21 上 腰 轴 受 力 结果 分 析 图 
3) 腰椎 。 腰 椎 分 为 两 部 分 ， 分 别 连 接 上 下 转动 部 分 和 左右 转动 部 分 。 两 部 分 通过 螺钉 相连 。 
假设 左右 方 回 转动 的 部 分 在 水 平方 向 回 是 ， 上 下 方 同 转 动 的 部 分 受 癌 下 的 力 ， 大 小 为 20N， 受 力 
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示意 图 如 图 8-22 所 示 。 受 力 结果 分 析 图 如 图 8-23 所 示 。 从 图 中 可 以 看 出 腰椎 的 强度 符合 要 求 。 
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图 8-22 ”腰椎 受 力 示意 图 图 8-23 ”腰椎 受 力 结果 分 析 和 图 


4. 模块 化 连接 板 的 设计 

连接 板 是 千足 虫 宠 物 机 器 人 腿 部 与 腰部 的 连接 器 件 ， 它 的 强度 、 设 计 方 式 和 形状 等 影响 
独 和 干 足 虫 宠物 机 器 人 的 整体 情况 。 因 此 ， 需 要 尽量 减轻 重量 ， 保 证 强度 ， 使 整体 达到 最 佳 。 

(1) 连接 板 的 主要 作用 

1) 放置 肩 部 ， 给 其 提供 固定 基础 ， 使 肩 部 能 机 位 置 固定 。 

2) 文 持 整个 腿 部 结构 ， 使 其 能 够 很 好 地 绕 Z 轴 进行 旋转 。 

3) 与 腰部 配合 相连 ， 实 现 整 体 的 快速 连接 。 

(2) 连接 板 的 结构 设计 为 了 能 更 加 体现 模块 化 的 特点 ， 便 于 加 工 ， 将 连接 板 从 整体 上 
设计 成 对 称 结构 ， 左 右 以 及 前 后 分 别 成 轴 对 称 。 下 面 确定 连接 板 的 尺寸 。 

通过 运动 分 析 可 知 ， 运 动 足 要 能 够 绕 最 底 端 的 伺服 电动 机 轴 旋 转 180”， 因 此 设 伺 服 电动 
机 轴 到 足 端 橡胶 底 距 离 为 由， 两 足 之 间距 离 为 2， 则 需 满足 2>201。 通 过 测量 可 得 最 底 端 的 伺 
服 电 动机 轴 与 足 端 橡胶 底 的 距离 为 86mm， 因 此 将 同 侧 两 运动 足 之 间距 离 设 计 为 190mm， 如 
图 8-24 所 示 ， 这 样 两 足 便 能 够 同时 旋转 而 不 发 生 运 动 干 涉 。 再 根据 轴承 大 小 ， 将 连接 板 的 整 
体 长 上 度 设计 为 220mm。 

根据 腰 的 长 度 及 对 连接 板 上 电路 板 放置 空间 的 考虑 ， 将 连接 板 的 宽度 设计 为 110mm。 连 
接 板 的 尺寸 设计 如 图 8-25 所 示 。 



































220mm 





图 8-24 连接 板 的 长 度 设计 图 8-25 ”连接 板 的 尺寸 设计 
连接 板 与 腿 的 连接 如 图 8-26 所 示 。 腿 轴 通 过 板 上 的 角 接触 球 轴承 限制 其 同 下 的 运动 ， 通 
过 板 齿 轮 箱 及 角 接 触 球 轴承 限制 其 向 上 的 运动 。 衣 机 通过 艇 机 染 固 定 在 板 上 预 设 的 槽 中 ， 
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档 了 轴 方 向 的 长 度 略 长 于 舵 机 针 方 回 的 长 度 ， 便 于 调整 锥 齿轮 中 心中 。 连 接 板 在 齿轮 箱 处 收 
系 ， 与 齿轮 箱 同 宽 ， 以 减少 板 的 质量 。 

连接 板 与 腰 的 连接 如 几 8-27 所 示 。 为 了 实现 快速 连接 , 采用 6 种 M4 螺钉 作为 连接 方式 。 
为 了 便于 快速 对 准 ， 将 加 强 肋 用 做 叶 问 部 分 ， 在 腰 上 设计 上 是 全 ,使 其 正好 插入 极 上 加 强 肋 构 
成 的 空间 中 ， 这 样 既 减 轻 了 重量 ， 也 能 保证 板 的 强度 。 











图 8-26 ”连接 板 与 腿 的 连接 图 8-27 ”连接 板 与 腰 的 连接 


(3) 强度 校 核 ”为 了 提 融 干 吓 虫 宠 物 机 器 人 的 运动 性 能 ， 减 轻 连 接 板 的 重量 ， 将 连接 板 
的 整体 厚度 设 为 3mm， 在 两 端 放 置 轴承 处 增 厚 为 8mm， 中 间 设 计 一 横 两 竖 三 道 加 强 肪 ， 并 在 
强度 要 求 不 高 的 地 方 进行 打 孔 操 作 。 在 进行 以 上 操作 后 ， 需 要 保证 连接 板 不 会 因为 千足 虫 老 
物 机 器 人 的 剧烈 运动 而 断裂 ， 在 Creo Simulate 1.0 中 对 连接 板 进 行 了 受 力 分 析 。 

为 了 分 析 人 简便 ， 将 板 上 的 电路 及 其 他 装置 简化 为 板 的 重量 ， 约 为 0.3kg， 两 哨 轴 承 处 承受 
腿 部 癌 下 的 力量 ， 四 个 螺纹 孔 承受 腿 部 网 上 的 力量 ， 单 条 腿 约 为 0.9kg; 中 部 对 轴 方 同 的 加 强 
肋 处 受到 腰部 癌 上 的 文 持 力 ， 螺 纹 孔 受到 癌 下 的 拉力 。 以 下 为 各 个 状况 下 板 的 受 力 分 析 情 况 。 

假设 千足 虫 宠物 机 器 人 保持 静态 ， 腿 部 抬 起 时 ， 两 庙 受到 同 下 的 压力 ， 中 部 收 到 同上 的 
文 持 力 ， 并 假设 中 部 忆 轴 方 回 的 加 强 肋 为 固定 关 ， 强 度 校 核 结 有 末 如 网 8-28 所 示 。 黄 色 箭头 部 
分 为 受 力 , 可 以 看 出 最 大 的 压强 为 4MPa,， 而 铝 的 屈服 强度 为 1$ 一 20MPa, 因此 强度 满足 要 求 。 

假设 干 吓 虫 宠物 机 器 人 腿 部 由 上 问 下 运动 ， 由 于 加 速度 ， 两 新 轴承 处 受到 3 倍 的 重力 ， 
约 为 27N， 中 部 依然 为 固定 端 ， 运 动 时 板 强度 校 核 结 果 如 网 8-29 所 示 。 从 图 中 可 以 看 出 ， 最 
大 压强 依然 小 于 铝 的 屈服 强度 ， 因 此 强度 满足 要 求 。 





























图 8-28 ”静态 时 板 强 度 校 核 结 图 8-29 ”运动 时 板 强度 校 核 结 
假设 千足 虫 宠物 机 器 人 腿 部 由 下 同上 运动 ， 由 于 加 速度 ， 腿 部 对 板 施 加 两 倍 重 力 的 拉力 ， 
约 为 18N， 拉 力 通过 齿轮 箱 传递 给 了 板 的 螺纹 孔 ， 板 中 部 依旧 固定 ， 强 度 校 核 结 果 如 图 8-30 








所 示 。 从 图 中 可 以 看 出 ， 最 大 压强 小 于 10MPa， 强 度 满 足 要 求 。 
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假设 千足 虫 宠 物 机 器 人 前 一 体 记 大 空 ， 则 中 部 螺纹 孔 受 到 癌 下 约 为 22N 的 力 ， 强 度 校 核 
结 末 如 图 8-31 所 示 。 从 图 中 可 以 看 出 ， 最 大 压强 小 于 10MPa， 满 足 强度 要 求 。 














图 8-30 ”承受 拉力 时 板 强 度 校 核 结果 图 8-31 前 一 体 节 悬空 时 板 强度 校 核 结 采 图 

综 上 可 得 连接 板 的 设计 基本 满足 设计 要 求 。 
8.3.2 ”运动 仿真 及 步 态 设计 

1. 运动 仿真 

为 了 对 干 足 虫 宠物 机 需 人 进行 运动 仿真 ， 上 首先 对 建立 的 模型 进行 分 机 。 在 八 足 形式 下 ， 
干 足 虫 宠物 机 帮 人 共 拥 有 4 个 体 布 ,46 个 目 由 度 。 要 使 46 个 电动 机 按照 预想 的 动作 达到 了 预定 
的 角度 ， 其 间 保 持 一 致 性 并 不 是 一 件 容 易 的 事情 。 为 了 便于 进行 有 序 的 控制 ， 采 用 对 每 一 个 
目 由 度 进行 编写 的 方法 ， 如 图 8-32 所 示 ， 将 机 需 人 按 规 律 分 成 从 0 到 7 共 八 组 ， 将 各 个 直流 
角 位 移 伺 服 电动 机 及 脚 部 的 直流 有 刷 电 动机 按 次 序 依次 编号 ， 使 每 一 个 电动 机 都 有 一 个 目 己 
的 ID， 以 便于 仿真 及 后 续 的 程序 设计 。 
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图 8-32 各 目 由 度 编 号 


在 完成 编写 之 后 ， 在 Pro/E 中 按 规 定 顺序 依次 为 机 器 人 的 各 目 由 度 添 加 伺服 电动 机 控制 
量 ， 在 腿 部 锥 齿轮 传动 处 添加 齿轮 连接 约束 ， 可 得 到 运动 仿 丰 模型 ， 如 图 8-33 所 示 。 

对 于 每 一 个 伺服 控制 量 ， 总 的 来 说 有 三 种 伺服 控制 方式 ， 分 别 是 位 置 伺服 、 速 度 伺服 和 加 
速度 伺服 。 针 对 所 用 电动 机 的 不 同 ， 将 直流 角 位 移 伺服 电动 机 选 为 位 置 伺服 控制 ， 通 过 建立 各 
时 刻 不 同 位 置 处 能 机 的 角 位 移 数据 表 ， 对 其 进行 运动 仿真 。 在 其 运动 过 程 中 ， 对 表 中 的 数据 进 
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行 线性 插值 ， 便 能 在 Pro/E 中 输出 千足 虫 宠 物 机 融 人 的 仿真 结 示 。 对 于 脚 部 的 直流 有 刷 电动 机 ， 
选用 速度 伺服 控制 方式 ， 通 过 设 定 不 同时 刻 直 流 有 刷 电 动机 的 运动 速度 ， 对 其 进行 控制 。 


by 入 连接 
Y 多 电动 机 
Y 分 伺服 

p ServoMotor0 (POS - ZZONGZHUANGPED 
pb % ServoMotorl (POS - ZZONGZHUANGPED 
b 2 ServoMotor2 (POS - ZZONGZHUANGPEDN) 
bp % ServoMotor3 (POS - ZZONGZHUANGPED 
p 9 ServoMotor4 (POS - ZZONGZHUANGPET) 
bp 9 ServoMotory (POS - ZZONGZHUANGPED) 
bp % ServoMotor6 (POS - ZZONGZHUANGPED 
pb DD ServoMotor7 (POS - ZZONGZHUANGPED) 
p DD ServoMotor8 (POS - ZZONGZHUANGPEI) 
* % ServoMotor9 (POS - ZZONGZHUANGPED 








图 8-33 ”在 Pro/E 中 的 运动 仿真 模型 
在 进行 仿真 的 过 程 中 发 现 左右 两 腿 舵 机 ， 以 及 同一 条 腿 上 上 下 两 个 关 市 的 舵 机 顺 时 和 针 或 
逆 时 针 旋 转 的 不 同 会 使 关节 转动 角度 增加 或 减 小 。 为 了 更 为 清晰 地 掌握 各 关节 转动 方 同 对 其 
当前 角度 的 影响 ， 先 画 出 如 图 8-34 所 示 的 各 关节 角度 数值 分 布 图 。 
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图 8-34 各 关节 角度 数值 分 布 图 
2. 步 态 规划 
针对 干 足 虫 宠物 机 右 人 的 机 械 结 构 ， 首 移 从 单 体 和 入 手 ， 研 究 机 器 人 能 够 摆 出 的 造型 。 
再 充分 结合 目 然 界 中 各 种 生物 的 运动 方式 及 合理 的 想象 ， 设 计 出 了 十 几 种 的 单 腿 姿势 。 图 8-35 
所 示 为 四 种 典型 的 单 腿 姿 势 。 














图 8-35 ”四 种 典型 的 单 腿 姿势 
a) 站 立 式 b) 届 曲 式 c) 侧 立 式 d) 昆虫 式 
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在 得 到 如 上 各 种 腿 部 姿态 后 ， 记 录 下 上 述 姿 势 时 腿 部 各 能 机 当前 的 数值 ， 作 为 步 态 设计 
时 的 初始 数据 。 不 同 腿 部 姿势 对 应 的 能 机 数值 示意 图 如 图 8-36 所 示 。 


吴迪 苹 苹 


图 8-36 不 同 腿 部 姿势 对 应 的 舵 机 数值 示意 图 

何 单 来 说 ,行走 步 态 束 是 相同 的 儿 个 关键 巾 的 重复 出 现 。 一 般 关 键 帆 的 数量 为 4， 因 此 只 
需要 找到 这 些 关 键 帧 便 能 构造 出 一 个 步 态 。 经 过 多 次 实验 ， 在 Pro/E 中 得 到 了 多 种 步 态 数据 ， 
并 以 一 定 的 数据 格式 记录 在 Excel 文件 中 。 利 用 MATLAB 将 各 个 电动 机 的 数据 分 别 导 成 以 时 
间 为 模 坐 标的 控制 量变 化 文件 ， 并 将 其 输入 到 各 个 电动 机 的 控制 项 中 ， 使 46 个 电动 机 按照 预 
定 的 规律 进行 动作 ， 便 可 在 Pro/E 中 看 到 仿真 动画 。 但 得 到 仿真 动 画 并 不 是 最 终 目标 ， 还 需要 
对 得 到 的 仿真 数据 的 真实 性 和 可 靠 性 进行 验证 ， 才 能 将 其 真正 地 用 于 实际 样机 的 调试 过 程 中 。 
以 腿 式 行走 为 例 进行 说 明 。 

对 于 腿 陈 行走 ， 选 用 三 角 步 态 作为 千足 虫 宠 物 机 器 人 的 行走 方式 。 其 大 致 运动 过 程 如 下 : 

1) 机 器 人 8 足 同 时 看 地 ， 做 姿态 调整 ， 准 备 开 始 运动 。 

2) 机 器 人 1，3，5，7 号 腿 抬 起 ，0，2，4，6 号 腿 保持 着 地 动作 。 

3) 机 器 人 1，3，5，7 号 腿 着 地 ，0，2，4，6 号 腿 同 时 抬 起 。 

4) 重复 2)、3) 步 的 动作 ， 使 机 器 宠物 一 直 问 前 走 。 

通过 运动 仿真 ， 证 实 了 和 干 足 虫 宠物 机 器 人 在 运动 过 程 中 各 个 构件 间 不 存在 运动 干涉 ， 机 
号 保持 平稳 前 进 ， 行 走 顺 畅 ， 各 足 无 滑 移 现 象 发 生 。 

在 Pro/E 中 还 得 到 了 各 个 伺服 电动 机 控制 量 的 变化 曲线 。 图 8-37 所 示 为 在 进行 腿 式 行走 
过 程 中 ，0 号 和 胡 机 的 运动 位 移 、 速 上 度 和 加 速度 曲线 。 在 考虑 到 和 直线 插 补 的 影响 后 ， 可 以 看 出 在 
机 器 人 运动 的 过 程 中 ，0 号 和 衣 机 的 角度 、 角 速度 及 角 加 速度 的 变化 曲线 都 较为 平滑 ,没有 出 现 
较 大 的 跃迁 现象 ， 只 是 在 文 撑 相 与 摆动 相交 人 蕉 时 刻 ， 该 和 天 市 处 的 角 加 速度 波动 较 大 ， 但 幅度 
在 可 以 接受 的 范围 内 ， 仍 能 够 使 千足 虫 宠 物 机 器 人 平稳 运行 。 


个 服 电动 机 办 户 ，0 号 舵 机 
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图 8-37 0 与 和 胡 机 的 运动 位 黎 、 速 度 和 加 速度 曲线 
a) 角 位 移 变化 曲线 
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0b. 册 |. 的 外. $M 由 [hp 下 而 1 | 各 ,心中 el. tel 
Cc) 
图 8-37 0 号 艇 机 的 运动 位 移 、 速 度 和 加 速度 曲线 〈 续 ) 
b) 角速度 变化 曲线 c) 角 加 速度 变化 曲线 
下 面 分 析 提 供 速 度 伺 服 的 脚 部 直流 电动 机 的 情况 。 图 8-38 所 示 为 在 原 地 回转 步 态 中 ， 
写 脚 部 直流 电动 机 的 角 位 移 及 角速度 随时 间 变 化 的 曲线 。 可 以 看 出 ， 曲 线 变 化 平稳 ，i 0 
合 直 流 电 动机 的 变化 规律 ， 满 足 运 动 要 求 。 


伺服 电动 机 轮廓 : 38 号 脚 部 直流 电动 机 























0.00 1.00 2.00 3.00 4.00 5.00 7.00 8.00 9.00 
日 ”位置 图 cdeg) 时 间 一 用 户 提供 的 点 中 的 位 轩 
一 一 会 一 一 一 速度 图 (deg/s) 全 一 一 用 户 提 供 的 点 中 的 速度 
图 8-38 38 号 脚 部 直流 电动 机 的 角 位 移 及 角速度 随时 间 变 化 的 曲线 
得 到 各 运动 动作 的 步 态 数据 之 后 ， 可 以 将 其 应 用 在 以 下 两 个 方面 : 
1) 将 得 到 的 各 关节 运动 曲线 直接 导入 到 3D MAX 中 的 轨迹 视 几 -曲线 编辑 器 中 ， 变 成 3D 
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模型 的 关节 运动 曲线 ， 从 而 可 得 到 更 高 质量 的 3D 动画 。3D 模型 的 关节 运动 曲线 如 图 8-39 所 
示 ， 部 分 3D Max 动画 截屏 如 图 8-40 所 示 。 








| 6 门 | 50 1 


0:56:43650) 1:11:650 :25:1740 1:39:283) 414:53:3920) 2:8:2 训 2:22:1300) 2:36:2390) 2:50:3 
了 HH DD -上 F\ 一 一 
8-39 3D 模型 的 关节 运动 曲线 


2) 将 得 到 的 步 态 数据 的 具体 数值 存在 excel 文件 中 ， 作 为 后 期 步 态 函 数 编写 的 数据 来 源 。 
还 可 以 将 数据 稍 作 变换 ， 便 用 在 程序 之 中 ， 简 化 程序 的 设计 过 程 。 

通过 虚拟 现实 中 的 运动 仿真 模拟 及 步 态 设计 ， 得 到 了 几 十 种 步 态 的 步 态 数据 ， 充 分 说 明 
了 千足 虫 屁 物 机 磊 人 忌 目 由 度 下 运动 的 复杂 程度 。 其 机 械 结构 能 够 你 证 在 如 此 多 的 步 态 下 运 
动 不 发 生 干 涉 ， 并 且 能 够 较 好 地 完成 ， 充 分 次 明了 结构 设计 的 精妙 程度 。 运 动 仿 真 为 实物 样 
机 页 定 了 坚实 的 理论 基础 ， 为 千足 虫 龙 物 机 器 人 完成 真实 运动 做 好 了 铺垫 。 





8-40 3D Max 动画 截屏 


8.3.3 ”控制 系统 硬件 电路 设计 


千足 虫 宠 物 机 器 人 的 控制 系统 总 体 框 图 如 图 8-41 所 示 。 整 个 控制 系统 主要 包括 控制 模 
块 、 电 源 定理 模块 、 电 动机 驱动 模块 、 通 信和 模块 、 传 感 检 疯 模块 及 电动 机 执行 模块 。 
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上 位 机 控制 


QO 
系统 控 抽 核心 过 | 运动 榨 抽 核心 | 运动 控 抽 核心 | 运动 控制 核心 | 
一 一 一 
人 可 行 棋 
| 二 


传感器 | 传感器 | 传感器 
图 8-41 ”控制 系统 总 体 框图 

由 于 千足 虫 宠物 机 器 人 的 机 械 部 分 采用 模块 化 设计 ， 可 以 自由 增 减 肢 节 ， 在 控制 系 硬件 
电路 设计 方面 ， 也 要 适应 这 一 特点 ， 可 实现 电路 的 增 减 。 硬 件 电路 设计 采用 总 分 模式 ， 如 图 
8-42 所 示 。 主 电路 用 于 高 层 控制 、 对 外 通信 及 摄像 头 、 无 线 模块 等 外 设 的 控制 ， 可 以 同时 对 
所 有 的 分 电路 进行 控制 ， 处 理 分 析 各 个 分 电路 传 回来 的 信息 。 各 个 分 电路 功能 相似 ， 采 用 模 
妃 化 设计 ， 分 别 控制 各 个 肢 节 实现 各 种 步 态 动作 ， 可 以 随机 械 结构 一 起 增 减 ， 并 且 各 个 分 电 
路 之 间 可 以 依次 向 后 传递 数据 ， 用 于 实现 步 态 数据 的 依次 传递 





























图 8-42 ”使 件 电 路 设计 思路 图 





在 标准 的 8 足 形式 下 ， 机 器 人 只 有 46 个 目 由 度 ， 也 就 是 说 电路 需要 稳定 地 控制 46 个 电动 
机 ， 实 现 多 种 运动 模式 、 多 种 运动 姿态 的 完美 结合 ， 所 以 在 电路 设计 方 和 面 ， 要 充分 考虑 到 控制 
量 众多 的 情况 。 经 过 研究 ， 机 硕 人 的 控制 系统 采用 遥控 与 日 主 控制 相 结 合 的 形式 ， 根 据 执 行 任 
务 的 复杂 程度 采用 不 同 的 控制 方式 ， 保 证 机 需 人 只 有 超 强 的 运动 功能 和 众多 的 动作 方式 。 

使 件 电 路 实现 的 主要 功能 分 为 以 下 几 个 阶段 : 

1) 可 以 较 好 地 张 动 控 制 多 个 电动 机 《〈 八 足 形 式 下 为 46 个 )。 

2) 使 机 器 人 能 够 按照 预定 程序 实现 多 种 步 态 。 

3) 机 夫人 能 够 与 外 部 进行 通信 ， 接 受 外 部 人 员 指 令 ， 依 据 远程 遥控 对 其 进行 操作 ， 增 强 
其 应 对 环境 的 能 力 ， 提 局 娱乐 程度 。 

4) 机 磊 人 能 够 依据 目 吴 传 感 咽 获得 的 数据 ， 目 主 分 析 周 围 环境 ， 与 使 用 者 形成 互动 ， 实 
现 智能 化 的 目标 。 

1， 控 制 模块 

针对 控制 系统 的 特点 ， 选 用 美国 ARM 公司 生产 的 32 位 STM32 为 核心 微 处 理 右 ， 以 实现 对 
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多 伺服 器 的 高 速 控制 ， 使 机 器 人 能 高 效 流畅 地 展示 出 多 达 几 十 
种 的 运行 步 态 。STM32F103 心 片 如 图 8-43 所 示 。 该 必 片 的 内 
核 为 32 位 的 CortexrM-M3 CPU， 上 有 具有 最 高 72MHz 的 工作 频率 ， 
能 够 满足 响应 时 间 要 求 。 它 拥有 3 个 通用 定时 器 ， 一 个 高 级 控 
制定 时 需 (PWM 定时 器 )， 能 够 输出 12 路 PWM 波 ， 便 于 精确 
控制 电动 机 。 另 外 ， 它 有 2 个 SPI，2 个 IC，3 个 串口 ，51 个 
GPIO 端口 以 及 2 个 12 位 ADC 模块 ,电路 可 扩展 性 强 。 与 其 他 
模块 的 接口 参数 如 下 : 需要 提供 2.0 一 3.6V 的 工作 电压 ,用 于 维 
持 芯 片 正 常 工 作 ; LO 口 最 大 承受 电压 为 SV， 故 输入 信号 电压 
应 在 5V 以 下 ; 输出 电压 在 3V 左右 ， 输 出 电流 可 达 8mA。 探 制 模 块 电路 图 如 图 8-44 所 示 。 





图 8-43 ”STM32F103 芯 
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图 8-44” 探 制 模 块 电路 图 


2. 电源 模块 

由 于 机 载 设备 较为 复杂 ， 无 法 将 各 供电 电压 统一 ， 所 以 需要 对 设备 供电 系统 进行 设计 。 
首先 分 析 各 模块 的 电压 要 求 。 

STM32F103 心 族 的 供电 电压 为 2.0 一 3.6V, 无 线 模块 NRF24L01 的 供电 电压 为 1.9 一 3.6V， 
加 速度 传感器 模块 的 供电 电压 为 2.4~3.6V。 故 采用 3.3V 电压 对 以 上 各 部 分 进行 供电 。 

L298N 电动 机 驱动 芯片 需要 的 供电 电压 为 4.5 一 7V， 摄 像 头 的 供电 电压 为 SV，MAX485 
芯片 的 供电 电压 为 SV， 故 采用 5V 电压 对 以 上 各 部 分 进行 供电 。 

实现 腰部 上 下 运动 及 腿 部 Z 轴 方 回旋 转 所 需 的 下 流 角 位 移 伺服 电动 机 Hitec HS-7980TH 
与 辉 契 MG995 的 供电 电压 为 7.4V， 故 需要 7.4V 电压 供电 。 

实现 腰部 左右 运动 及 腿 部 了 轴 方 回旋 转 所 需 的 直流 角 位 移 伺 服 电 动机 XQ-S4230D 的 供电 
电压 为 12V， 故 需要 12V 电压 供电 。 
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脚 部 Maxon 直流 空心 杯 电 动机 的 供电 电压 为 24V， 故 还 需要 24V 的 电压 供电 。 

综 上 所 述 ， 需 要 提供 的 电压 有 3.3V、5V、7.4V、12V 和 24V。 

由 于 3.3V 和 5V 主要 是 必 卢 供电 ， 不 需要 太 大 的 功率 ， 故 可 以 通过 降 压 获得 ， 而 直流 角 
位 移 伺 服 电 动机 的 消耗 功率 比 直 流 空心 杯 电动 机 大 ， 所 以 采用 7.4V 与 12V 双 电 池 供 电 。 其 他 
电压 值 均 通 过 升 压 或 降 压 获得 。 选 用 的 电池 参数 见 表 8-3。 


表 8-3 选用 的 电池 参数 








电压 什 放电 倍率 极限 放电 电流 





电池 二 2800mAh 11.1V 3SC 98A 


为 了 实现 电压 变化 ， 采 用 升 压 及 降 压 模块 来 实现 电压 升降 。 

(1) 7.4V-5V 采用 LM2596 降 压 模块 ， 降 压 电 路 如 图 8-45 所 示 。LM2596T-5.0 心 片 的 输 
入 电压 要 求 是 7~40V， 输 出 电压 为 SV， 输 出 负载 电流 为 0.2~3A。 

(2) 5V-3.3V ”采用 LM1117 降 压 模块 ， 降 压 电 路 如 图 8-46 所 示 。LM1117DT-3.3 心 片 的 
输入 电压 要 求 是 4.75$ 一 10V， 和 输出 电压 为 3.3V， 输 出 电流 为 0 一 800mA。 


+7.4V 








+5V U6 LMI1117DT-3.313.3V 





C13 C14 
10uF, tan | 10uF, tan 





图 8-45 7.4V-5V 降 压 电路 图 8-46 5V-3.3V 降 压 电路 
(3) 11.1V-24V 采用 LM25S77 升 压 模块 ， 升 压 电 路 如 图 8-47 所 示 。LM2577S-ADJ 心 
的 输入 电压 为 3 一 30V， 输 出 电压 为 4V-3SV。 
总 结 起 来 ， 电 压 转 化 可 以 用 图 8-48 表示 。 






VM 输出 8V 


十 C27 
680uF 


11.1V EE 24V 


图 8-47 11.1V-24V 升 压 电路 图 8-48 ”电压 转化 


3. 电动 机 驱动 模块 
为 了 实现 对 肢 部 直流 空心 杯 电 动机 的 有 驱动， 采用 L298N 电动 机 驱动 心 片 。L298N 是 SGS 
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公司 的 产品 ， 内 部 包含 4 通道 逻辑 驱动 电路 ， 是 一 种 二 相 和 四 相 电 动机 的 专用 驱动 右 ， 接 收 
标准 TTL 逻辑 电 平 信号 ， 可 驱动 44V、2A 以 下 的 电动 机 。 同 一 蕊 片上 集成 有 CMOS 控制 电 
路 和 DMOS 功率 器 件 ， 利 用 它 可 以 与 主 处 理 颖 、 电 动机 和 增 量 型 编码 器 构成 一 个 完整 的 运动 
控制 系统 。 将 其 放置 于 分 电路 板 上 , 正好 驱动 同一 体 节 肢 部 的 两 个 电动 机 , 其 电路 图 如 图 8-49 
所 示 。 











C15 


OUTL | OUT? 
100pF 
C16 


ouTs || OUT4 
DI 不 D2 不 D3 不 D4 100pF 
I 1 


OUT2| 1I3 | 
ENA OUT3 “== = 涵 
号 GND 人 EN B 二 D7 ZAR DS 


GND5 


+24V 





GND24 
图 8-49 ”电动 机 驱动 电路 图 
为 了 实现 更 精确 的 控制 , 减少 电动 机 运转 对 控制 芯片 的 影响 , 需要 实现 主 控制 芯片 STM32 
和 L298N 的 物理 隔离 ， 使 电动 机 的 运转 不 影响 控制 芯片 。 采 用 在 两 者 之 间 加 入 光 耦 隔离 。 经 
比较 ， 选 择 TLP521 作为 隔离 光 厢 ， 其 电路 图 如 图 8-50 所 示 。 














RP3 
INI1 
RP4 
IN2 
R8 
RP1 1 [ |416 
RP2 2 
RP7 RP3 一 |114 
RP4 4 一 13 +5V 
IN3 RP5 -== 
RP6 Gl 
RP7 7 0 -| 
RP8 RP8 := 
= 
IN4 
ee RP9 RP9 
1K 
ENA RP10 RP10 
IK 
请 RP11 RP11 
IK 
ENB RP12 RP12 
IK 


TLPS21-2 


图 8-50” 光 厢 阳 离 电 路 图 
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4. 通信 模块 

通信 模块 分 为 两 大 部 分 ， 一 部 分 是 千足 虫 宠物 机 器 人 上 自身 的 通信 ， 另 一 部 分 是 人 机 通信 。 

(1) 自身 通信 千足 虫 宠物 机 器 人 目 身 的 通信 也 主要 由 两 部 分 构成 ， 一 部 分 是 主 电路 板 
与 分 电路 板 之 间 的 通信 ， 主 要 实现 主 控制 芯片 对 分 控制 芯片 的 同时 操控 ， 另 一 部 分 是 分 电路 
之 间 的 前 后 相互 通信 ， 主 要 用 来 依次 癌 后 传递 步 态 数据 。 

主 必 上 请 STM32 提供 的 通信 方式 主要 有 以 下 几 种 : 

1) TC 总 线 通信 。STM32 提供 两 个 了 C 总 线 接口 ， 能 够 工作 于 主 模式 或 从 模式 ， 支 持 标 
; 准 和 快速 模式 ， 文 持 7 位 或 10 位 寻 址 ，7 位 从 模式 时 文 持 双 从 地 址 寻 址 ， 内 置 了 便 件 CRC 发 
生 堪 / 校 验 器 。 可 以 使 用 DMA 操作 并 文 持 SMBus 总 线 2.0 版 PMBus 总 线 。 

在 速度 方面 ， 串 行 的 8 位 双 问 数据 传输 位 速率 在 标准 模式 下 可 达 100Kb/s， 人 快速 模式 下 可 
达 400Kb/s， 闹 速 模式 下 可 达 3.4Mb/s。 

2) 通用 同步 /异步 收发 器 (USART)。STM32 提供 了 3 个 串口 接口 。 接 口 通信 速率 可 达 
4.5Mb/s， 其 他 接口 的 通信 速率 可 达 2.25Mb/s。USART 接口 具有 硬件 的 CTS 和 RTS 信号 管 
理 、 支 持 IDA SIR ENDEC 传输 编 解码 、 兼 容 ISO7816 智能 卡 并 提供 LIN 主 / 从 功能 ， 且 所 有 
USART 接口 都 可 以 使 用 DMA 操作 。 

3) 串 行 外 设 接口 (SPI)。STM32 提供 2 个 SPI 接口 ， 在 从 模式 或 主 模 式 下 ， 全 双 工 和 半 
双 工 的 通信 速率 可 达 18Mb/s。3 位 的 预 分 频 器 可 产生 8 种 主 模式 频率 ， 可 配置 成 每 帧 8 位 或 
16 位 。 人 硬件 的 CRC 产生 / 校 验 支 持 基 本 的 SD 卡 和 MMSC 模式 。 所 有 的 SPI 接口 都 可 以 使 用 
DMA 操作 。 

4) 其 他 。STM32 还 提供 一 个 USB2.0 全 速 接口 和 一 个 CAN2.0B 主动 接口 ， 可 以 实现 多 
种 通信 。 

在 比较 了 各 总 线 的 速度 、 实 用 性 及 管 脚 分 布 后 ， 决 定 采用 速度 最 快 的 SPI 总 线 负责 前 后 
两 体 节 间 的 快速 通信 ， 采 用 USART 接口 实现 主 控制 板 一 对 多 的 同时 控制 ， 即 采用 如 图 8-51 
所 示 的 通信 方式 。 


主 控制 板 








































































分 控制 板 分 控制 板 分 控制 板 
图 8-51 通信 方式 


由 于 串口 通信 距离 较 长 ， 为 避免 信号 损耗 采用 MAX485 心 族 作为 串口 通信 处 理 心 帮 。 
MAX485 接口 芯片 是 Maxim 公司 的 一 种 RS-485 芯片 .MAX485 的 驱动 器 可 以 实现 最 高 2.5Mb/s 
的 传输 速率 。 这些 收 发 器 在 驱动 右 禁 用 的 空 载 或 满载 状态 下 , 吸取 的 电源 电流 为 120 一 S00HA。 
所 有 器 件 都 工作 在 5V 单 电 源 下 。 了 驱动器 具有 短路 电流 限制 ， 并 可 以 通过 热 关 断 电 路 将 驱动 器 


他 
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的 输出 署 为 高 阻 状 态 。 接 收 器 输入 具有 失效 保护 特性 ， 当 输入 开路 时 ， 可 以 确保 逻辑 高 电 平 
输出 ， 具 有 较 高 的 抗 干扰 性 能 。 串 口 通信 电路 图 如 图 8-52 所 示 。 











GND5 
图 8-52 ”串口 通信 电路 图 

(2) 人 机 通信 “人 机 通信 主要 用 来 实现 操控 者 对 千足 虫 宠物 机 器 人 的 远程 遥控 ,主要 是 
遥控 器 与 主 蕊 片 之 间 的 通信 。 为 了 实现 这 一 功能 。 采 用 NRF24L01 无 线 心 片 。NRF24L01 是 
一 球 工 作 在 2.4 一 2.SGHz 世界 通用 ISM 频段 的 单 片 无 线 收 发 右 心 片 。 无 线 收发 右 包 括 : 频率 
发 生 器 、 增 强 型 SchockBurst “模式 控制 器 、 功 率 放 大 器 、 唱 体 振 荡 器 调制 器 和 解 调 器 。 输 
出 功率 频道 选择 和 协议 的 设置 可 以 通过 SPI 接口 进行 设置 。 它 具有 极 低 的 电流 消耗 ， 当 工作 
在 发 射 模式 下 发 射 功率 为 -6dBm 时 ， 电 流 消耗 为 9.0mA， 接 收 模 式 时 为 12.3mA， 掉 电 模 式 
和 待机 模式 下 电流 消耗 更 低 。 其 电路 原理 图 如 图 8-53 所 示 。NRF24L01 芯片 通过 SPI 总 线 
与 主 控制 已 片 相连 接 ,， 将 接收 到 的 无 线 信 号 传递 给 主 控制 已 片 ， 从 而 实现 操控 者 对 机 占 人 的 
远程 操控 。 











| 
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, CE 
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5. 传 感 检 测 模块 

为 了 实现 千足 虫 宠 物 机 器 人 的 智能 化 自动 行走 ， 需 要 给 机 器 人 安 钱 一 系列 的 传感器 ， 感 
受 外 界 信息 ， 并 反馈 给 主 探 芯 片 ， 使 机 器 人 能 够 依照 外 界 条 件 上 自动 调节 自身 行走 状态 。 主 要 
采用 了 以 下 几 种 传感器 ， 用 以 获取 外 界 环境 数据 。 

(1) 加 速度 传感器 “选用 飞 思 卡尔 公司 的 MMA7455L 作为 三 轴 加 速度 传感器 核心 。 
MMA7455L 是 一 款 数字 输出 (TC/SPI)、 低 功 耗 、 紧 凑 型 电容 式微 机 械 加 速度 计 ， 具 有 信号 调 
理 、 低 通 滤 波 器 、 温 度 补偿 、 自 测 、 可 配置 通过 中 断 引 脚 〈INTI1 或 INT2) 检测 0g 及 脉冲 检 
测 “ 用 于 快速 运动 检测 ) 每 功能 。 其 电路 图 如 图 8-54 所 示 。 




















图 8-54 加 速度 传 感 硕 电路 疼 


加 速度 传感器 是 根据 压 电 效应 的 原理 来 工作 的 。 通 过 计算 产生 电压 与 所 施加 的 加 速度 之 
间 的 关系 ， 就 可 以 将 加 速度 转化 成 电压 输出 ， 从 而 获得 加 速度 数值 。 

(2) 超声 波 传 感 占 ”选用 HC 一 SR04 作为 超声 波 测 距 工具 ， 如 网 8-55 所 示 。 它 由 超声 波 
发 射 器 、 接 收 器 与 控制 电路 组 成 ， 可 提供 2 一 400cm 的 非 接触 式 距离 感 测 功 能 ， 测 距 精 度 可 达 
3mm。 通 过 IC 接口 与 主 控制 芯片 相连 。 

















十 SV 
触发 信号 输入 
回 啊 信 号 输出 

GND 


LA UUs 








图 8-55 ”超声 波 传感器 
该 传感器 的 基本 工作 原理 是 : 采用 IO 口 TRIG 触发 测 距 ， 给 出 至 少 10ps 的 高 电 平 信号 ; 
模块 上 自动 发 送 8 个 40kHz 的 方 波 , 目 动 检测 是 否 有 信号 返回 ; 特有 信和 号 返回 ,通过 IO 口 ECHO 
输出 一 个 高 电 平 ， 高 电 平 持续 的 时 间 惑 是 超声 波 从 发 射 到 返回 的 时 间 ; 测试 距离 =〈 高 电 平 时 
间 x 声 速 (340nys)) /2 。 
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利用 超声 流传 感 锅 主要 是 为 了 测量 机 右 人 与 家 里 物品 的 距离 ， 了 预防 其 撞 到 增 或 者 其 他 物 
品 ， 实 现 避 障 功 能 。 

(3) 摄像 头 模 卖 ”为 了 获取 外 界 图 像 信 息 ， 增 强 机 占 人 的 互动 性 ， 在 机 器 人 上 加 闭 摄 像 
头 模块 ， 如 图 8-56 所 示 。 其 工作 原理 是 : 按 一 定 的 分 辩 率 ， 以 隅 行 扫 揪 的 方式 采样 图 像 上 的 
点， 当 扫 描 到 茶点 时 ， 就 通过 疼 像 传 感 公 上 户 将 该 点 处 图 像 的 灰 度 转换 成 与 灰 度 成 一 一 对 应 天 
系 的 电压 值 ， 然 后 将 此 电压 值 通 过 视频 信号 站 输出 。 











图 8-56 摄像头 模块 


6. 电动 机 执行 模块 

千足 虫 宠物 机 器 人 采用 多 关节 多 电动 机 驱动 ， 其 每 一 体 季 〈 包 括 腰 ) 上 有 12 个 电动 机 ， 
其 中 包括 10 个 角 位 移 伺服 电动 机 和 2 个 直流 空心 杯 电动 机 。 构 成 8 足 形 式 时 ， 共 有 38 个 角 
位 移 伺服 电动 机 和 8 个 直流 衬 心 杯 电 动机 。 

为 了 提高 电动 机 使 用 率 ， 保 证 机 器 人 正 各 运行 。 依 据 不 同 关 节 处 所 需 关 币 力 窍 大 小 对 电 
动机 进行 合理 选 型 。 根 据 需 求情 况 ， 使 用 不 同 扭矩 的 电动 机 。 电 动机 在 机 器 人 上 的 安装 位 置 
如 图 8-57 所 示 。 




















HS-7980TH 





XQ-S4230D 





区 MAXON 电 动机 
图 8-57 ”电动 机 在 机 器 人 上 的 安装 位 置 


在 腿 部 Z 轴 方向 转动 部 分 ， 由 于 所 十 力 沧 不 大 ， 奉 动作 合理 ， 最 大 力 滤 小 于 100N * em。 
采用 辉 辟 MG995 金属 此 轮 艇 机 伺服 右 提 供 动 力 ， 该 骨 机 的 相关 参数 见 表 8-4。 
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表 8-4 辉 盛 MG995 金属 齿轮 舵 机 伺服 器 参数 表 
工作 电压 结构 材质 金属 铜 具 ， 空 心 杯 电动 机 ， 双 深 珠 轴承 
工作 扭矩 反应 有 无 负载 速度 0.17s/60” (4.8V)，0.13s/60”(6.0V) 
使 用 温度 40.7mmx19.7mmx42.9mm 
重量 
二 本 本 30cm， 信 号 线 ( 黄 )、 电 源 线 ( 红 )、 地 线 ( 暗 红 ) 
工作 死 区 





机 絮 人 腿 部 处 轴 方 癌 的 转动 部 分 是 承受 机 器 人 重力 的 主要 部 位 。 在 茶 些 步 态 过 程 中 ， 该 


部 分 要 承受 








高 达 250N。cm 的 扭 果 。MG995 的 最 大 输出 扭矩 只 有 130N。cm， 不 足以 提供 相 





应 的 动力 。 于 是 选用 XQ-power 公司 的 XQ 一 S4230D 金属 齿轮 舵 机 伺服 器 提供 动力 。 在 腰 兰 








左右 方 回转 动 部 分 


表 8-5 XQ 一 S4230D 金属 齿 





轮 艇 机 伺服 器 


， 也 采用 了 此 球 骨 机 。 该 骨 机 的 相关 参数 见 表 8-5 所 示 。 


参数 表 


工作 电压 结构 材质 爹 属 铀 项， 空心 杯 电动 机 ， 双 滚珠 轴承 
24.SON。cm (9.6V) 

工作 扭矩 于 we 请 反应 转速 无 负载 速度 0.15s/60”(9.6V)，0.13s/60” (12V) 
30.80N。cm (12V) 

重量 56 壕 拉 线 
。 30cm， 信 号 线 〈 黄 )、 电 源 线 〈 红 )、 地 线 〈 暗 红 ) 
工作 死 区 4hs 
在 腰部 上 下 方 回 转动 部 分 ， 由 于 要 提起 整个 体 节 ， 上 所 需 扭 矩 最 大 。 故 选用 扭矩 更 大 的 
HITEC HS 一 7980TH 艇 机 提供 动力 。 其 参数 见 表 8-6。 
表 8-6 HS 一 7980TH 金属 齿轮 舵 机 伺服 器 参数 表 

工作 电压 结构 材质 金属 铀 上 中， 空心 杯 电动 机 ， 双 深 珠 轴承 
380N。cm (6V) 

工作 扭矩 反应 转速 无 负载 速度 0.20%60" (6V)，0.17s/60” (7.4V) 
460N。cm (7.4V) 


重量 连接 线 
工作 死 区 长 度 


在 足 部 轮 式 转动 部 分 ， 选 用 MAXON 直流 有 刷 电 
动机 。 其 主要 特点 是 : 体积 小 、 重 量 轻 、 线 性 度 好 (无 
齿 模 效应 )、 转 动 惯量 小 、 反 应 迅速 、 过 载 能 力 强 、 效 
率 高 ， 并 且 具 有 民 好 的 抗 电厂 干扰 能 

由 于 机 右 人 对 和 直流 电动 机 的 输出 力 窍 有 一 定 的 要 
求 , 选择 瑞士 MAXON 22mm 空心 杯 伺服 减速 电动 机 ， 
如 图 8-58 所 示 ， 相 关 参 数 见 表 8-7。 该 电动 机 带 有 集 
成 编 公 占 ， 可 以 直接 检测 返回 速度 信息 。 
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30cm， 信 号 线 〈 芮 )、 电 源 线 〈 红 )、 地 线 《〈 晓 红 ) 








图 8-58 MAXON 直流 有 刷 电 动机 
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表 8-7 MAXON 022-00.19-31 器 件 参 数 


额定 电压 24V 

转速 550r/min 

减速 比 1:256 

堵 转 扭矩 0.45N。m 

连续 扭矩 0.IN。m 

二 机 身 直 径 22mm， 长 73mm， 轴 径 4mm 


8.3.4 ”控制 系统 软件 程序 设计 


干 是 虫 宠物 机 絮 人 为 多 体 市 重复 串联 的 结构 。 单 个 体 节 包括 一 对 是 和 一 个 腰 ， 其 中 单个 
足 具 有 $ 个 自由 度 ， 单 个 腰 具 有 2 个 自由 度 。 对 于 8 足 形式 ， 有 4 个 体 节 串 联 而 成 ， 其 中 一 
个 体 节 去 除 腰 部 结构 ， 共 需 控 制 的 关节 数量 为 46 个 。 在 单个 足 部 结构 中 ， 安 装 有 4 台 骨 机 ， 
一 台 Maxon 直流 有 有 刷 电动 机 ; 在 单个 腰部 结构 中 ， 安 装 有 两 合 艇 机 。 针 对 这 样 的 机 构 形式， 
为 了 有 效 地 完成 控制 任务 ， 控 制 系统 需要 上 只有 以 下 特点 : WW 具有 民 好 的 多 组 脉 党 调制 控制 能 
力 ; 书 多 组 脉 帝 调制 之 间 解 炎 ，(3) 具 有 民 好 的 实时 性 ， 以 保证 运动 的 协调 性 。 

为 达到 控制 的 目的 , 并 保证 运动 的 效 来 , 设计 了 三 层 忌 线 分 层 控制 的 方 条 , 如 图 8-59 所 示 。 


























体 节 控制 右 1 : 
关节 控制 器 1.N 
关节 控制 器 2.1 


4 
总 控制 器 体 节 控 制 器 2 人 


关节 控制 器 2.N 


关节 控制 器 ML.1 
体 广 控制 器 M 关节 控制 器 M.2 


图 8-59 三 层 总 线 分 层 控制 图 

1) 第 一 层 为 总 控制 项。 控制 下 级 体 季 控制 器 ， 并 与 外 界 通信 。 在 人 机 交互 时 对 人 的 指令 
进行 识别 、 分 机， 确定 行动 方 辣 及 步 态 。 

2) 第 二 层 为 体 世 控制 葵 。 其 任务 是 : 

G) 根据 指令 ， 计 算 所 在 体 市 的 各 个 关 市 每 个 时 刻 的 具体 运 动 角度 。 

@ 对 反馈 的 信息 进行 预 处 理 ， 完 成 基本 的 反射 行为 ， 将 有 价值 的 信息 加 上 级 传递 。 

3) 第 三 层 是 各 个 关节 的 驱动 电路 及 直接 控制 右 。 

三 条 总 线 分 别 为 痛 神 经 总 线 、 相 邻 神经 总 线 和 心率 总 线 。 其 中 有 有 神经 总 线 与 总 控制 匡 和 
体 季 控制 瑚 相连 ， 用 于 总 控制 右 发 布 命令 ， 获 得 反馈 数据 ;， 相 邻 神 经 总 线 存 在 与 相 邻 两 体 节 
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之 则 ， 负 责 相 邻 两 体 亨 控制 器 之 间 的 数据 通信 ; 心率 总 线 与 总 控制 器 和 体 节 控制 占 相 连 ， 总 
控制 器 通过 心率 总 线 控制 整体 的 运动 节奏 ， 傈 证 多 个 体 季 控制 器 的 协调 统一 。 

选用 ST 公司 的 STM32F103RB 微 控制 器 作为 主 控制 右 与 体 节 控制 占 。ST 公司 的 STM32 
系列 基于 为 高 性 能 、 低 成 本 、 低 功 耗 的 散 入 式 应 用 专门 设计 的 ARM Cortex-M3 内 核 。 其 外 设 
包括 : lnus 的 双 12 位 ADC、4Mb/s 的 UART、18Mb/s 的 SPI、18MHz 的 VO 翻转 速度 ， 集 成 
了 复位 电路 、 低 电压 检测 、 调 压 器 和 精确 的 RC 振荡 器 等 。 

总 控制 句 中 , 选用 USART3 作为 将 神经 总 线 接口 ，SPI2 作为 相 邻 神经 总 线 的 主 器 件 接 口 ， 
RB6 为 心率 总 线 控 制 问 。 

体 节 控制 器 中 ， 依 然 选 用 USART3 作为 雁 神 经 总 线 接口 ，SPI2 作为 相 邻 神经 总 线 的 主 器 
件 。 不同 的 是 增加 SPI3 作为 相 邻 神经 总 线 的 从 器 件 接口 ，RB6 为 心率 上 总线 接 收 端 。 所 控制 的 
目 由 度 中 ， 有 10 个 通过 艇 机 提供 动力 ， 由 2 个 通过 直流 电动 机 提供 动力 。 有 机 的 控制 信号 为 
脉 宽 调 制 信 号 ， 其 周期 固定 ， 由 高 电 平 所 占 时 间 长 短 来 决定 肯 机 输出 的 和 角度。 直流电 动机 通 
过 张 动心 卢 张 动 ， 所 需 信号 同样 为 脉 宽 调制 信号 ， 不 同 的 是 由 占 空 比 来 控制 电动 机 的 转速， 
以 及 两 路 电 平 信号 控制 正 反 转 。 

通过 以 上 分 析 ， 对 于 体 节 控制 锅 而 言 ， 需 要 发 出 12 路 脉 宽 调制 信号 。 通 过 得 疝 STM32 
开发 手册 ， 了 解 到 STM32F103RB 拥有 4 个 时 钟 ， 其 中 时 钟 1 为 高 级 定时 器 时 钟 ， 可 生成 6 
路 带 死 区 的 两 两 互补 的 脉 宽 调制 信号 ， 适 合 控制 电动 机 ， 时 钟 2 一 4 为 普通 定时 器 时 钟 ， 每 个 
时 钟 可 生成 4 路 周期 相同 的 脉 宽 调 制 信号 。 这 里 选用 时 钟 2~4 生成 12 路 周期 相同 的 脉 宽 调 
制 信 号 ， 分 别 作为 12 个 上 自由 度 的 控制 信号 。 由 于 使 用 了 LN298 电动 机 驱动 芯片 ， 所 以 在 控制 
直流 电动 机 时 可 以 不 使 用 高 级 定时 器 1， 而 将 其 留 做 它 用 

疹 神 经 总 线 同时 与 多 个 微 控制 器 相连 ， 进 行 通信 时 ， 需 区 分 不 同 的 微 控 制 右 。STM32F103 
的 USART 功能 带 有 多 处 理 右 通信 和 模式， 在 此 模式 下 ， 单 帧 传送 的 学 节 长 度 为 9b， 其 中 最 高 
位 为 工时 为 地 址 帧 ， 最 高 位 为 0 时 为 数据 帧 。 当 STM32F103 收 到 自己 的 地 址 帧 时 ， 进 入 接收 
状态 ， 当 收 到 其 他 的 地 址 帧 时 ， 进 入 静默 状态 ， 不 接收 此 USART 口 的 任何 数据 。 信 和 号 接收 模 
式 如 图 8-60 所 示 。 



























































本 例 中 ， 当 前 的 接收 各地 址 是 1 RXNE RXNEF 
(配置 在 USART_CR2 寄 存 器 中 ) 


| 六 











Re | 静默 模式 正常 模式 静默 模式 
| 
z 2 | > / 
未 匹配 的 地 址 匹配 的 地 址 未 匹配 的 地 址 
RWU 设 置 为 1 
(RXNE 已 被 清除 ) 





图 8-60 ”信号 接收 模式 
设计 出 以 下 两 种 控制 程序 模式 及 编写 的 思路 。 
(1) 直接 命令 模式 “在 总 J systick 中 新， 在 进入 systick 中 断后 ， 通 过 心率 总 
线 发 布 时 钟 信 号 ， 并 检查 是 否 需 要 发 送 指令 。 在 需要 发 送 指令 时 ， 将 各 个 体 节 的 关节 角度 、 
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第 8 章 千足 虫 宠 物 机 器 人 


速度 值 通过 兰 神 经 总 线 发 给 各 个 体 和 控制 器 。 体 和 控制 名 在 检测 到 目 己 的 地 址 后 ， 通 过 中 断 
接收 命令 ， 存 入 指令 队列 。 在 收 到 心率 总 线 发 来 的 时 钟 信 号 后 ， 进 入 外 部 中 断 ， 通 过 插值 将 
现 阶 段 的 各 个 关节 的 角度 计算 出 来 ， 控 制 脉 宽 调制 信号 ， 并 判断 是 售 需 要 该 取 下 一 个 指令 。 

(2) 传递 指令 模式 ”在 总 控制 器 中 设置 systick 中 断 ， 在 进入 systick 中 断后 ， 通 过 心率 总 
线 发 布 时 钟 信 号 ， 通 过 插值 将 下 一 组 各 个 关节 的 角度 计算 出 来 ， 通 过 相 邻 神经 总 线 传递 给 下 
一 个 体 丰 控制 器 ， 体 和 控制 器 通过 DMA 将 指令 存 入 队列 。 当 体 节 控制 器 在 收 到 心 座 总 线 发 来 
的 时 钟 信 号 后 ， 进 入 外 部 中 断 ， 根 据 队 列 中 的 指令 控制 脉 宽 调 制 信号 。 

直接 命令 模式 的 优势 在 于 可 以 将 各 个 关节 分 别 探 制 ， 但 将 神经 总 线 占用 市 宽大 ， 尤 其 是 
体 世 数量 增长 时 ， 对 带宽 的 要 求 将 会 严重 制约 体 布 的 数量 。 传 递 指令 模式 的 优势 在 于 可 以 将 
指令 逐 级 后 传 ， 体 方 数量 的 增加 不 会 影响 总 控制 器 的 负 答 。 

在 实际 编写 控制 程序 时 ， 综 合 了 以 上 两 种 思路 ， 对 于 实时 性 强 的 指令 ， 采 用 下 接 命 令 模 
式 ， 对 于 周期 性 的 指令 ， 采 用 传递 指令 模式 。 程 序 流程 图 如 图 8-61 和 图 8-62 所 示 。 控 制 的 
重点 在 于 脉 宽 调制 信号 的 产生 。STM32F103 中 的 定时 器 有 六 种 模式 ， 分 别 是 输入 捕获 模式 、 
PWM 输入 模式 、 强 制 输出 模式 、 输 出 比较 模式 、PWM 模式 、 单 脉冲 模式 。 这 里 选用 PWM 
模式 ， 通 过 设置 周期 与 高 电 平 时 间 ， 可 以 将 指令 准确 地 以 脉 宽 调制 的 形式 表达 出 来 ， 且 无 需 
占用 核心 资源 ， 利 用 时 钟 本 喘 即 可 控制 引 脚 电 平 。 当 需要 通过 半 控 或 其 他 方式 控制 时 ， 只 需 
将 Gait Prepare 函数 中 Act 的 值 交 由 所 对 应 程序 控制 即 可 。 
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图 8-61 总 控制 器 流程 图 
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图 8-6G2。 体 节 控制 器 流程 图 
[天 四 主要 创新 点 必 取 得 的 成 果 


8.4.1 “作品 主要 创新 点 
作品 主要 创新 点 如 下 : 





(1) 单 运动 足 设计 上 曲 辟 结构 形式 的 设计 减 小 了 腿 部 连接 点 的 重力 宅 ， 使 各 关节 受 力 
均 习 ， 扩 大 了 可 这 域 ; 运动 足 腿 却 变 计 和 毗 云 设计 的 配合 ， 使 于 足 虫 宠物 机 硕 人 既 有 腿 却 机 
骼 人 地 形 适 应 性 强 的 优点 ， 又 有 轮 陈 机 左 人 机 动能 力 高 的 优 点 。 

(2) 连接 方式 上 采用 链接 式 的 模块 化 组 合 ， 可 使 干 足下 宠物 机 器 人 实现 醒 块 的 目 由 增 
减 ， 增 强 了 运动 步 态 和 里 体 姿 态 的 可 塑性 和 灵活 性 。 

(3) 运动 形式 上 ”腰部 链接 使 千足 虫 宠 物 机 右 人 可 实现 在 起 伏 路 面 上 的 行走 ， 腰 部 与 运 
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动 足 的 配合 实现 了 千足 虫 宠物 机 器 人 多 种 姿态 的 变换 ， 更 加 接近 真实 的 动物 运动 状态 ， 摆 脱 
了 以 往 机 械 宠物 只 能 腿 部 运动 或 腰部 转动 的 单调 形象 。 

(4) 控制 方式 上 ”采用 分 层 北 阶 式 的 控制 系统 体系 结构 ， 遥 控 与 自主 控制 相 结 合 的 控制 
方式 ， 实 现 了 多 电动 机 的 协调 控制 ， 有 效 保证 了 千足 虫 宠物 机 器 人 运动 的 协调 性 与 稳定 性 。 


8.4.2 ”作品 取得 的 成 果 


作品 取得 的 成 果 如 下 : 

1) 千足 虫 宠物 机 器 人 原理 样机 1 台 。 

2) 千足 虫 宠物 机 器 人 研究 技术 报告 1 份 。 

3) 申请 国家 发 明 专 利 2 项 : 

G 一 种 基于 模块 化 的 多 关节 链 节 式 机 器 人 。 

@ 一 种 节肢 机 器 人 的 轮 腿 式 运动 古 设计 。 

4) 获得 首都 高 校 第 六 届 机 械 创 新 设计 大 赛 一 等 奖 。 


忆 结 与 展望 


8.5.1 作品 研 友 工作 总 绪 


1， 作 品 特色 

千足 虫 宠物 机 器 人 以 第 五 届 (2012 年 ) 全 国 大 学 生机 械 创新 设计 大 赛 的 主题 “幸福 生 
活 一 一 今天 和 明天 ”为 设计 要 求 , 紧 紧 围绕 家 庭 用 娱乐 机 械 这 一 目标 展开 , 是 一 球 以 机 械 设 计 
为 主 ， 毕 合 运用 机 电 一 体 化 技术 的 产品 。 在 精巧 的 机 械 结构 的 基础 上 ， 项 目 组 充分 发 挥 控制 
对 机 械 性 能 的 提升 作用 ， 辅 以 各 种 传 感 探 测 设备 ， 使 干 足 虫 宠物 机 器 人 有 具有 了 不 同 于 一 般 机 
械 的 展示 效果 。 其 具体 优点 如 下 : 

1) 机 身 灵活 度 高 ， 八 足 形式 下 自由 度 可 达 46 个 。 在 机 械 结构 的 保证 下 ， 可 以 实现 多 达 
儿 十 种 的 步 态 ， 展 示 效 果 非 常 好 。 

2) 腿 部 结构 简单 紧凑 ， 空 间 利用 率 高 。 融 合 了 腿 式 行走 与 轮 式 运 动 的 优点 ， 使 千足 虫 宠 
物 机 器 人 的 运动 性 能 大 大 提高 。 

3) 采用 模块 化 设计 ， 可 以 自由 拼接 组 装 。 在 具有 电源 体 节 与 主 控 世 片 体 节 的 前 提 下 ， 理 
论 上 可 以 实现 任意 多 节 的 连接 。 

2. 存在 的 问题 

虽然 项 目 组 投入 了 大 量 的 时 间 和 精力 于 千足 虫 宠物 机 器 人 的 研发 中 ， 但 由 于 技术 水 平 以 
及 研究 经 费 的 限制 ， 千 足 虫 宠物 机 器 人 仍然 存在 许多 需要 改进 的 地 方 ， 体 现在 以 下 几 个 方面 : 

1) 腰部 虽 已 实现 了 绕 Z 轴 与 轴 方 同 的 旋转 ,但 缺少 绕 了 轴 方 同 的 旋转 ， 如 果 能 够 加 上 
该 方 同 的 目 由 度 ， 和 干 足 虫 宠物 机 器 人 的 运动 将 更 加 灵活 。 

2) 由 于 采用 铝 作为 机 械 结构 的 主要 材质 , 千足 虫 宠物 机 器 人 的 整体 重量 约 为 10kg， 对 于 
家 庭 玩 具 来 说 ， 重 量 还 是 偏 大 ， 移 动 不 是 特别 方便 。 

3) 8 足 形式 下 需要 46 个 电动 机 ， 电 动机 使 用 数量 较 多 ， 使 得 千足 虫 宠物 机 器 人 的 整体 稳 
定性 不 是 特别 高 ， 控 制 难度 较 大 。 
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4) 由 于 线 绕 较 多 ， 而 且 直 接 上 暴露 在 体外 ， 容 易 造 成 刮 擦 扯 搜 ， 影 啊 美 观 。 

3. 改进 建议 

针对 上 述 提出 的 问题 ， 提 出 以 下 改进 的 方案 : 

1) 重 设 腰部 结构 ， 增 加 了 才 方 向 的 旋转 ， 增 加 实现 前 后 两 世上 下 滑 移 的 朔 置 ， 使 千足 时 
宠物 机 右 人 能 够 你 持 较 好 的 形态 。 

2) 采用 塑料 或 是 其 他 的 较 轻 的 材料 作为 机 械 结 构 的 材料 ， 对 受 力 不 太 大 的 地 方 进行 轻 量 
化 处 理 。 

3) 制作 一 整套 较为 完备 的 控制 系统 , 由 于 千足 虫 宠 物 机 器 人 需要 控制 的 目 由 度 确实 较 多 ， 
只 能 在 电路 及 控制 方面 提高 稳定 性 。 

4) 在 机 械 结 构 上 预 设 埋 线 的 沟 道 ， 将 连接 线 藏 在 其 中 ， 使 千足 虫 宠物 机 器 人 的 外 观 更 为 
漂亮 ， 且 整体 性 更 强 。 


8.5.2 ”作品 应 用 泄 围 及 前 景 分 析 


目前 市 面 上 存在 看 形形色色 的 机 电 类 玩具 ， 例 如 日 本 索尼 公司 的 机 器 狗 、 各 式 变 形 金 刚 
等 。 它 们 不 仅仅 是 儿 鞋 的 最 爱 ， 也 吸引 了 越 来 越 多 青年 人 甚至 于 中 年 人 的 目光 。 融 科技 玩具 
己 经 成 为 了 一 种 路 越 年 龄 界限 而 广 受 欢迎 的 物品 ， 其 市 场 现 在 仍 处 于 供不应求 的 状态 ， 人 们 
对 于 机 电 类 玩具 有 很 强烈 的 兴趣 ， 但 市 场 上 的 机 械 玩 共 数 量 有 限 ， 可 玩 性 高 的 更 是 黎 有 ， 可 
以 说 这 一 市 场 是 一 块 有 符 做 大 的 指 糕 。 

项 目 组 设计 的 千足 虫 宠 物 机 器 人 是 一 称 极 具 市 场 竞 争 力 的 仿生 机 械 絮 乐 产 品 ， 它 填补 了 
机 械 玩 具 市 场 种 类 不 足 的 空 日 ， 抢 占 了 一 席 之 地 。 

首 完 ， 由 于 采用 模块 化 设计 ， 在 电源 组 体 市 ， 主 探 已 厂 体 市 羔 有 的 情况 下 ， 可 以 由 使 用 
者 目 由 增添 体 节 ， 组 装 成 任意 长 度 进 行 运动 ， 带 给 使 用 者 极 大 的 目 由 ， 能 够 提升 使 用 者 的 兴 
趣 。 对 于 儿童 ， 还 可 起 到 锻炼 智力 的 作用 。 

其 次 ， 千 足 虫 龙 物 机 器 人 既 可 以 如 同 索尼 的 机 械 狗 一 样 ， 展 现 各 种 步 态 舞蹈 ， 与 人 进行 
互动 ， 还 能 如 同 变形 金刚 一 样 改变 目 己 的 身体 形状 ， 呈 现 各 种 造型 ， 上 共有 极 大 的 目 由 度 ， 可 
以 由 操作 者 进行 控制 ， 人 机 交 注 充分 。 

再 次 ， 倘 名 投 入 市 场 生 产 ， 全 机 骨架 可 以 用 塑 压 成 型 的 方式 制作 ， 不 仅 可 以 大 大 减少 成 
本 ， 而 且 由 于 材料 换 成 塑料 ， 整 体 动作 需要 的 动力 也 将 减少 ， 可 选用 更 便宜 的 电动 机 ， 加 之 
模块 化 设计 ， 整 机 成 本 可 以 控制 在 500 元 左右 。 价 格 上 很 有 竞争 力 ， 且 整体 质量 大 为 减 小 ， 
更 加 适宜 走 入 寻常 百姓 家 。 
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(第 五 届 全 国 大 学 生机 械 创新 设计 大 赛 二 等 奖 ，2011 年 ) 


CE 作品 研究 时 育 景 及 意义 


目前 人 们 进行 健身 多 采用 两 种 途径 进行 ， 一 是 在 专业 的 健身 房 办 理会 员 卡 ， 定 期 利用 那 
里 系统 先进 的 健身 设备 及 教练 指导 资源 进行 锻炼 ， 二 是 购买 健身 教学 书籍 或 视频 ， 在 家 中 利 
用 简单 的 右 械 目 我 进行 锻 烧 。 在 这 两 种 情况 中 ， 前 者 往往 花费 十 分 郧 中 ,一 张 健 里 月 卡 动 纯 
束 要 上 干 元 ， 聘 请 私人 教练 指导 健 映 更 足 属于 少数 人 可 以 人 主 受 的 餐 侈 服务 ， 后 者 叉 往往 由 于 
缺少 专业 的 健 映 如 材 与 正确 的 指导 而 事倍功半 ， 甚 侈 无 功 而 返 。 以 上 两 种 健 映 方式 均 有 难以 
导 锡 的 整 奖 。 因 此 ， 如 何 找到 一 种 合适 的 健 吴 途径 ， 既 能 够 让 使 用 者 邓 受 到 专业 健身 需 材 的 
使 用 感受 与 私人 教练 役 的 一 对 一 指导 ， 又 可 以 降低 健身 成 本 ， 让 普通 大 众 可 以 接受 ， 是 目前 
健身 领域 总 需 解决 一 大 难题 。 

现在 市 场 上 可 以 购 得 的 健身 豆 械 基本 分 为 两 大 炎 : 重 物 类 健身 需 与 图 性 元 件 闫 健 吴 锻 。 
前 者 以 哑铃 、 杠 铃 及 框架 牵引 健身 器 为 代表 ， 哑 铃 、 杠 铃 尽 管 价 格 低廉 ， 但 用 其 可 以 得 到 银 
炼 的 人 体 部 位 却 往往 有 限 ， 而 且 缺 乏 保 护 作用 ;框架 牵引 健身 需 尽 管 更 加 专业 ， 而 且 可 以 对 
哑铃 无 法 锻炼 到 的 部 位 进行 弥补 ， 但 往往 体积 大 ， 价 格 高 ， 非 一 般 家 庭 所 适用 。 一 套 组 合 “ 框 
架 这 引 ” 健 喘 右 ， 少 则 三 四 千 元 ， 多 则 上 万 元 。 匹 其 应 当 指出 的 是 ， 重 物 关 健 吴 左 有 其 特别 
的 劣势 ， 即 往往 需要 上 百 公 斤 配 套 的 金属 重 物 。 这 在 运输 与 安装 过 程 中 是 极其 不 便 的 。 弹 性 
元 件 闫 健 喘 喜 小 巧 轻便 ， 且 没有 累 资 的 重 物 ， 有 其 一 定 的 优势 ， 但 由 于 其 运动 阻力 往往 为 变 
力 ， 且 其 阻力 大 小 与 人 体 肌 端 位 移 的 变化 关系 缺乏 人 体 构 造 学 上 的 科学 匹配 规律 ， 往 往 不 为 
专业 的 健身 人 群 所 接受 ， 因 此 多 数 沦落 为 “电视 购物 ”的 牺牲 品 。 以 上 两 闫 健 吴 厂 ， 均 有 其 
不 可 强 补 的 旺 端 。 在 此 情况 下 ， 寿 能 设计 出 一 种 将 两 类 健 喘 帮 优点 集 于 一 喘 ， 即 不 需要 累 菊 
的 重 物 ， 叉 节省 空间 ， 还 能 实现 符合 人 体 工程 学 阻力 变化 规律 的 健 映 机 械 ， 定 将 会 受到 健 喘 
界 尤 其 是 青年 健身 爱好 者 的 普 近 欢迎 。 

随 腹 信息 技术 的 飞速 发 展 ，“ 智 能 健 吴 ”已 经 成 为 健身 领域 发 展 的 必然 趋势 。 如 何 整 合 
使 用 者 的 个 人 肌体 信息 ， 为 其 量 吴 打造 科学 合理 的 健 喘 计划 ;同时 在 其 进行 健身 时 通过 电子 
系统 给 予 其 专业 的 动作 指导 与 保护 ， 最 大 程度 上 提高 健 吴 的 效率 ， 并 减少 受伤 的 发 生 概 率 ， 
这 些 问 题 均 可 以 通过 健身 需 材 的 机 电 一体 化 控制 得 到 圆满 的 解决 。 

同时 我 们 应 注意 到 ， 这 样 一 种 能 够 满足 人 们 健 吴 需要 ， 同 时 结合 机 电 一 体 化 技术 ， 具 有 
一 定 “ 智 能 ”的 健身 用 品 ， 其 本 喘 的 工作 诛 理 也 将 满足 医疗 保健 中 牵引 类 康复 器 械 的 各 项 性 
能 需要 ， 在 针对 中 老年 人 与 瘫痪 病人 的 康复 治疗 中 同样 有 看 广阔 的 应 用 前 景 。 

1. 国内 外 研究 现状 与 发 展 趋势 

“外 骨骼 ”类 机 械 的 历史 由 来 已 入， 早 在 上 世纪 60 年 代 束 有 一 些 国 家 提出 了 “外 骨 散 ” 
助力 设备 的 设计 构想 ， 并 制造 了 原理 样机 。 但 是 受到 当时 制造 水 平 与 电器 元 件 性 能 的 制约 ， 
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这 一 构想 没有 能 够 在 当时 得 到 完整 实现 。 

随 着 社会 整体 工业 水 平 的 进步 ， 时 至 今日 ， 世 界 各 国 已 经 涌现 出 多 球 “ 外 骨骼 ”产品 或 
原理 样机 。 其 设计 目的 与 工作 机 理 各 不 相同 ， 均 有 独到 的 特点 。 但 总 的 来 说 目前 已 有 的 “外 
骨骼 ”可 以 分 为 三 大 类 别 。 

(1) 助力 型 “外 上 骨骼” 机械 ”此 类 外 上 骨骼 以 增强 人 类 能 力 为 目的 ， 以 电气 或 液压 驱动 元 
件 作为 辅助 人 类 运动 的 施 力 件 ， 弥 补 使 用 着 自身 力量 的 不 是 ， 从 而 大 幅度 提升 人 类 的 行动 能 
力 。 但 由 于 其 特殊 的 功效 性 ， 此 类 外 骨骼 往往 用 于 军事 领域 ， 作 为 一 款 新 兴 的 高 科技 军事 装 
备 出 现 。 如 美国 洛克 西 德 马 丁 公 司 的 HULC 下 上 肢 外 骨骼 ( 见 图 9-1)、 和 雷神 (SARCOS) 公司 
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图 9-1 洛克 西 德 马 丁 公 司 的 HULC 下 上肢 外 骨骼 图 9-2 雷神 公司 的 XOS2 全 身 助 力 外 骨骼 


(2) 康复 型 “外 骨骼 ”机 械 ”由 于 “外 骨骼 ”器 械 对 人 体 独特 的 “ 随 动 ”特性 ， 使 得 其 在 医 
疗 康复 领域 得 以 得 到 长 中 发展。 以 英国 萨 福 德 大 学 与 美国 华盛顿 大 学 的 康复 型 外 骨骼 为 例 。 他 们 
分 别 在 上 肢 设置 了 极其 复杂 的 机 械 结 构 ， 以 拟 合 人 体 极其 复杂 的 生物 运动 。 在 机 械 的 各 运动 副 处 ， 
分 别 设 置 了 小 力矩 电动 机 ， 用 于 牵引 使 用 患者 的 肢体 。 但 这 种 器 械 往往 因为 过 于 追求 拟 合 人 体 运 
动 、 结 构 过 于 复杂 ， 而 变 得 维修 困难 ， 价 格 昂贵 ， 很 难 被 一 般 消 费 者 接受 。 

(3) 操纵 型 “外 骨骼 ” 机械“ 由 于 “外 骨骼 ”的 “ 随 动 ”特性 ， 使 得 这 类 器 械 成 为 一 种 极其 
高 效 的 人 机 互动 机 器 人 。 通 过 采集 人 类 肢体 动作 ， 与 对 相应 运动 副 施加 阻力 ， 使 得 此 类 “外 骨骼 ” 
具有 很 强 的 人 机 交互 性 。 使 用 者 能 够 不 断 通过 运动 自己 肢体 来 为 计算 机 提供 实时 控制 信号 , 控制 其 
他 工作 环境 下 的 机 器 人 终端 ， 或 者 在 虚拟 现实 中 运动 自己 虚拟 的 “肢体 ” 此 类 作品 的 典型 代表 是 
韩国 科技 大 学 的 “机 器 人 控制 导 ” 与 意大利 比萨 圣 安 娜 大 学 的 “控制 与 虚拟 现实 触觉 回馈 外 骨骼 

2. 项 目 研究 目标 与 内 容 

本 项 目 将 针对 现今 健身 与 康复 器 材 的 种 种 缺点 与 不 足 ， 将 “外 骨骼 ”机 器 人 概念 引入 健 
身 与 康复 器 材 领域 ， 自 主 设计 开发 一 款 基于 操纵 灵活 、 作 用 可 靠 、 协 调 能 力 强 、 适 应 范围 广 
的 穿戴 式 健身 与 康复 器 械 。 以 电动 机 为 施 力 元 件 ， 通 过 合理 的 结构 设计 ， 精 确 贴 合 人 体 各 部 
位 运动 ， 并 具有 智能 控制 功能 。 让 健身 不 再 受到 器 械 繁 多 、 重 物 元 余 、 姿 势 不 标 准 、 请 教练 
昂贵 等 条 件 的 制约 ， 使 得 使 用 者 能 够 在 较 小 的 空间 内 〈 如 家 庭 室 内 ) 进行 全 面 、 专 业 的 健身 
锻炼 。 同 时 ， 所 设计 的 智能 健身 机 械 应 具有 一 定 的 康复 这 引 功能 ， 可 供 瘫痪 病人 或 老人 在 空 
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则 较 小 的 室内 (如 家 庭 中 ) 进行 康复 性 治疗 。 其 初版 设计 虚拟 样机 如 图 9-3 所 示 。 





图 9-3 “外 骨骼 ”智能 健身 与 康复 机 器 人 初版 设计 虚拟 样机 

“外 上 骨骼 ”智能 健身 与 康复 机 器 人 ， 将 是 一 球 具 有 一 定 智 能 的 高 度 机 电 一 体 化 产品 ， 改 变 
人 们 对 以 往 健 身 器 的 局 限 认识 ， 打 开 健 和 映 康复 器 械 的 新 疆域 ， 为 此 类 器 械 的 设计 提供 半 命 性 
的 细 新 思路 。 

“外 肯 骼 ”智能 健身 与 康复 机 器 人 应 具备 以 下 使 用 功能 : 

1) 采用 电动 机 作为 施 力 元 件 ， 不 用 重 物 或 绳索 、 弹 繁 等 弹力 元 件 进 行人 体 肌肉 力量 训练 。 

2) 随 看 锻 烁 效果 的 逐步 显现 ， 占 械 的 阻力 载 合 可 实现 小 捍 位 过 渡 增 加 (如 以 500g 为 一 
个 增加 单位 )。 

3) 不 受 重力 制约 ， 人 体 同一 部 位 运动 到 不 同 姿势 时 ， 器 件 施 加 阻力 的 大 小 及 变化 趋势 可 
随意 调整 。 

4) 采用 “和 穿戴 式 ” 设 计 ， 从 根本 上 解决 肌肉 锻炼 时 “器 械 不 全 ”的 限制 。 用 一 套 设备 可 
实现 人 体 在 任意 姿势 下 任何 动作 的 锻炼 ， 功 能 相当 于 一 个 专业 健身 房 所 有 器 械 的 总 和 。 

5) 拥有 “器 械 胶 体 长 度 调 整 ”功能 ， 可 根据 不 同 身 高 使 用 者 的 需求 自如 调整 各 关键 部 位 
的 尺寸 ， 如 四 肢 、 释 干 处 机 构 长 度 。 

6) 具有 “智能 教练 ”功能 。 本 作品 可 以 通过 附着 式 穿戴 ， 矫 正 使 用 者 锻炼 时 不 正确 的 姿势 ， 
从 而 避免 不 科学 锻炼 可 能 造成 的 伤害 。 同时， 控制 系统 还 可 以 根据 用 户 需 求 ,为 其 量 身 打造 锻炼 计 
划 。 如 各 个 姿势 的 锻炼 顺序 、 每 个 姿势 的 动作 数目 、 各 个 动作 的 力度 变化 等 。 

7) 具有 “安全 保护 ”功能 。 该 功能 主要 体现 在 “关节 运动 限 位 ”、“ 超 负荷 急 停 ”与 “ 防 
倾倒 安全 绳 ” 机 制 上 。“ 关 节 运 动 限 位 ”可 以 限制 器 械 中 各 转动 副 的 运动 范围 ， 使 其 与 人 体 
关节 的 运动 范围 相对 应 ， 从 而 避免 对 使 用 者 造成 伤害 。“ 超 负 蓓 急 停 ” 机 制 可 以 在 使 用 者 出 
现 “力不从心 ”无 法 健身 动作 时 ， 紧 急 将 健身 器 的 负载 变 为 0， 并 停 在 当前 姿势 处 ， 防 止 其 造 
成 传统 健身 器 材 使 用 时 十 分 常见 的 “运动 伤害 ”情况 。“ 防 倾倒 安全 强 ” 机 制 则 可 以 在 使 用 
者 出 现 难 以 保持 重心 ， 即 将 穿戴 嚣 械 坠 地 的 情况 下 ， 像 安全 带 一 样 及 时 从 上 方 拉 紧 器 械 整 体 ， 
从 而 避免 因 器 械 自 重 而 在 坠 地 过 程 中 对 使 用 者 造成 的 伤害 。 

8) 具有 简单 的 运动 姿势 教学 功能 ， 如 投 段 、 游 泳 、 网 球 挥 拍 、 高 尔 夫 挥 杆 等 动作 的 示 教 
功能 ， 通 过 “ 穷 戴 式 ”设计 让 使 用 者 切 喘 体验 标准 动作 ， 加 快 学 习 速 度 。 

9) 具有 丰富 的 人 机 互动 功能 ,整合 机 电 一 体 化 技术 与 无 线 网 络 技术 及 Android 操作 系统 ， 
设计 智能 友好 的 控制 界面 ， 实 现 恨 好 的 人 机 交互 功能 。 
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作品 概述 


9.2.1 ”研究 内 容 概述 


1. 机 械 结 构 设 计 需 求 

“外 骨骼 ”智能 健身 与 康复 机 器 人 的 机 械 结 构 设 计 过 程 中 需要 考虑 并 遵循 以 下 要 求 : 

1) 保证 整体 机 构 的 自由 度 设 置 能 够 满足 与 人 体 的 贴 合 性 ， 即 各 接触 点 、 面 机 械 一 侧 的 运 
动 轨 迹 能 够 通过 控制 各 上 自由 度 的 运动 规律 与 人 体 相 应 各 点 的 运动 轨迹 相 重 合 。 

2) 坚决 避免 运动 过 程 中 与 人 体 的 和 干涉， 防止 出 现 意外 。 

3) 应 采取 模块 化 的 设计 思路 ， 简 化 机 械 的 复杂 程度 ， 减 少 零 件 种 类 ， 同 时 增强 机 器 不 同 
部 位 间 零 件 的 可 移植 性 ， 方 便 运输 、 装 配 与 维修 ，。 

4) 各 模块 的 设计 应 在 保证 实现 自身 功能 与 经 济 性 的 前 提 下 ， 尽 量 使 用 轻 质 高 强 的 材料 ， 
选用 强度 较 高 同时 容易 加 工 的 结构 。 满 足 机 器 运作 时 的 强度 需求 ， 同 时 降低 自 喘 的 质量 ， 减 
少 对 后 方 串联 驱动 机 构 的 载 集 。 

5) 模块 中 的 各 功能 件 〈 如 电动 机 、 传 动 装置 ) 布局 合理 ， 尽 量 紧 凑 缩 小 每 个 模块 的 体积 。 

6) 各 模块 的 动力 输出 轴 系 应 具备 多 方向 的 承载 能 力 ， 即 可 承载 扭矩 ， 又 可 承载 弯 矩 ， 
时 保证 转动 时 输出 平稳 流程 。 

7) 机 构 总 体 需要 具备 根据 使 用 者 身高 不 同 而 变换 各 机 构 尺 寸 的 功能 。 此 功能 应 具体 体现 
在 某 一 些 模块 中 。 

8) 模块 间 的 连接 方式 设计 应 牢固 可 靠 ， 同 时 应 容易 拆 凶 ， 方 便 模 块 的 维修 与 更 换 。 

9) 所 选用 的 驱动 器 应 不 具备 机 械 性 的 目 锁 功能 〈 如 螺纹 传动 副 )， 同 时 应 具备 三 环 可 欣 
特性 ， 即 具备 “位 置 ”、“ 速 度 ” 和 “ 力 窍 ”的 可 探 性 。 

2， 控 制 与 驱动 系统 设计 需求 

“外 肯 骼 ”智能 健身 与 康复 机 器 人 的 功能 由 健身 和 康复 两 大 功能 模块 组 成 。 针 对 两 大 功 
能 ， 机 器 人 控制 系统 既 需 要 通过 控制 驱动 元 件 提供 阻力 窍 来 达到 健身 运动 的 目的 ， 也 需要 利 
用 张 动 元 件 提供 主动 力 窍 实现 康复 治疗 和 动作 示 教 功能 。 控 制 系统 将 实现 对 22 个 驱动 能 机 的 
位 置 、 速 上 度 的 团 环 控制 ， 并 可 实现 对 艇 机 的 力矩 控制 。 使 得 力矩 的 输出 符合 人 体 运 动工 程 学 
上 的 规律 ， 从 而 可 以 精确 拟 合 人 体 运 动 轨 迹 ， 实 现 健身 运动 时 “角度 ”、“ 力 度 ” 的 实时 反 
人 馈 功 能 和 实现 康复 窑 引 功能 和 标准 运动 姿势 教学 功能 。 控 制 系 统 结构 图 如 图 9-4 所 示 。 

驱动 系统 是 该 机 器 人 功能 实现 的 重要 组 成 部 分 ， 需 要 根据 机 器 人 功能 要 求 ， 对 驱动 电动 
机 进行 选择 ， 驱 动 电动 机 应 满足 如 下 要 求 : 

1)〉 电 动机 的 体积 应 尽 可 能 小 ， 不 应 超过 45mmx60mmx60mm-。 

2) 电动 机 的 输出 扭矩 应 尽 可 能 大 ， 且 不 小 于 180N。cm。 

3) 电动 机 的 转速 应 可 调 ， 最 快 转速 应 不 小 于 7r/min。 

4) 电动 机 得 出 轴 转 动 不 必 连续 转 整 周 ， 但 至 少 可 完成 0” 一 180"” 的 角 位 移 转 动 。 

5) 电动 机 拥有 角 位 移 、 速 度 、 力 矩 三 环 回 饥 功 能 。 其 中 角 位 移 回 馈 误 差 应 小 于 等 于 5°， 
速度 回馈 误差 应 小 于 等 于 5%。 

6) 电动 机 的 控制 电路 原理 与 程序 的 编写 应 尽 可 能 简单 。 
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7) 电动 机 的 布线 应 尽 可 能 简单 。 
8) 在 你 证 上 述 性 能 指标 的 前 担 下 ， 电 动机 应 具有 较 局 的 性 价 比 。 











图 9-4 控制 系统 结构 图 


3. 智能 化 人 机 交互 系统 设计 需求 

“外 骨骼 ”智能 健 喘 与 康复 机 器 人 将 配备 形式 丰 量 的 控制 终端 和 用 户 体 验 效 末 出 色 的 人 机 交 
互 功能 。 可 以 利用 PC、 平板 电脑 和 手机 每 终端 对 机 右 人 进行 操控 和 与 机 器 人 进行 互动 ， 将 在 作品 
内 置 健身 资料 库 , 对 使 用 者 进行 正确 健身 姿势 的 教学 和 纠正 ,并 可 以 针对 使 用 者 号 体 状 况 量 喘 制 定 
出 个 性 化 的 健身 或 康复 计划 。 作 品 具备 功能 全 面 的 控制 拓展 接口 ， 上 位 机 控制 系统 所 具备 的 WIFI 
通信 性 能 ， 实 现 与 具备 WIFI 功能 的 电子 设备 的 无 线 通信 ， 通 过 安装 有 Android 控制 终端 软件 的 移 
动 设备 终端 完成 对 机 左 人 的 远程 控制 。 同 时 , 利用 软件 用 户 可 以 在 手机 等 移动 终端 中 建立 私人 健身 
档案 , 包括 详细 运动 记录 与 卡路里 消耗 等 关键 健身 数据 的 记录 。 用户 可 以 在 不 同 的 机 械 上 ， 使 用 同 
一 部 手机 实现 同样 质量 的 “私人 服务 ”。 对 移动 终端 的 用 户 界 和 面 的 设计 将 满足 如 下 要 求 : 

1) 界面 简洁 明了 ， 用 户 可 以 非常 下 观 地 了 解 机 器 人 所 具有 的 功能 。 

2) 操作 简单 方便 ， 使 用 者 在 系统 简单 提示 后 即 可 快速 掌握 操作 方法 。 

3) 动态 效果 展示 ， 具 有 三 维 模 型 动态 展示 健身 或 康复 动作 ， 帮 助 用 户 快 速 熟 悉 将 要 完成 
的 动作 。 

4. 安全 性 考虑 

由 于 机 器 人 与 人 体 直接 接触 ， 机 器 人 安全 性 设计 的 重要 性 显而易见 ， 首 先 需 要 考虑 在 使 
用 机 器 人 时 可 能 出 现 的 危险 情况 。 

(1) 机 器 带动 人 类 肢体 运动 至 “关节 死 区 ”所 谓 “ 关 节 死 区 ”是 指 在 人 体 模型 中 将 各 关 
他人 稍 化 为 机 械 的 运动 副 后 ， 各 关节 无 法 在 现实 中 旋转 到 的 位 置 〈《 如 小 腿 相 对 与 大 腿 无 法 回 前 
人 要 曲 ， 小 臂 相 对 于 大 臂 无 法 辣 后 弯曲 )。 而 对 于 该 健身 康复 器 械 中 的 转动 副 ， 知 不 加 以 特殊 设 
计 ， 其 往往 可 以 绕 轴 线 日 如 转动 ， 不 存在 转动 角度 上 的 死 区 。 辱 在 机 械 带 动人 肢体 运动 的 模 
式 下 ， 如 健 吴 用户 体力 不 文 ， 吹 痪 病人 牵引 治疗 ， 或 控制 程序 出 现 故 障 ， 一 旦 机 械 胶 体 将 人 
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体 强 迫 得 带动 到 “关节 死 区 ”， 那 么 机 械 势 必 会 对 人 体 造 成 极其 严重 的 伤害 。 





























(2) 人 体 罕 戴 豆 械 时 失 稳 跌倒 由 于 该 健身 康复 作品 目 吴 的 功能 与 结构 特性 ， 使 得 其 具有 相 
当 可 观 的 目 身 重量 。 保 守 估 计 ， 一 套 全 身 的 完整 设备 的 重量 应 该 在 100kg 雹 右 。 帮 使 用 者 在 罕 戴 





者 亏 械 进行 锻 陈 或 治疗 时 ， 一 旦 因为 过 于 疲 苑 或 动作 不 协调 ， 导 臻 重心 失 稳 而 跌倒 ， 那 么 这 样 的 
后 果 将 十 灾难 性 的 。 因 为 在 这 种 悄 况 下 ， 耕 人 体 夹 在 占 械 与 地 面 之 间 ， 那 么 相当 于 整个 费 械 的 重 
量 都 会 被 加 载 在 人 体 上 。 上 所 以 在 进行 设计 时 ， 一 定 要 坚决 避免 这 种 危险 情况 。 

(3) 控制 系统 出 现 故 了 ”此 种 危险 情况 的 成 因 往 往 极 为 复 杀 ， 并 且 不 可 控 。 尽 管 此 类 故 
隐 出 现 频率 较 小 ， 但 是 一 旦 出 现 ， 除 对 使 用 者 的 舒适 感 造成 影响 外 ， 还 可 能 造成 前 面 提 到 的 
两 种 危险 情况 。 因 此 此 类 故障 的 后 果 同 样 严 重 ， 必 须 通 过 机 械 或 物理 手段 ， 防 止 在 控制 系统 
出 现 故障 时 对 人 体 造 成 任何 伤害 。 

(4) 和 危险 悄 况 发 生 后 此 械 依 然 在 运作 ”一旦 上 述 三 种 危险 情况 发 生 ， 由 于 机 械 的 运动 程 
序 已 经 在 使 用 前 预 设 定好 ， 所 以 尽管 右 械 对 使 用 者 的 伤害 已 经 通过 各 机 械 手 段 避 免 ， 但 是 机 
名 各 运动 副 的 继续 工作 依然 有 可 能 对 使 用 者 造成 进一步 的 伤害 。 所 以 必须 在 适当 的 时 刻 ， 由 
使 用 者 目 行 决定 需 械 是 售 紧 急 停 机 。 


9.2.2 ”技术 指标 


技术 指标 如 下 : 

1) 外 肯 骼 穿戴 式 智 能 健身 与 康复 机 器 人 样机 采用 人 机 工程 技术 拟 实 制作 1:2 比例 模型 ， 
高 上 度 <lm， 重 量 <2Skg。 

2) 机 器 人 整体 具有 22 个 自由 度 。 

3) 可 实现 精确 拟 合 健身 和 康复 主要 运动 时 人 体 运 动 轨迹 ， 驱 动 元 件 运 动 性 能 符合 人 体 运 
动 特点 。 

4) 智能 控制 系统 包括 中 央 主 控 单 元 、 关 市 驱动 控制 单元 、Android 客户 端 及 触摸 屏 客户 端 。 

5) 电源 系统 采用 220V 交流 电 供电 。 


天 键 近 术 


9.3.1 人 体 解剖 学 与 胶体 运动 机 理 分 析 拉 术 


1. 人 体 四 上肢 的 构造 与 运动 模型 

解剖 学 研究 人 体 运 动 的 基本 思想 是 ， 人 体形 态 结构 与 运动 拉 能 的 统一 性 和 相互 制约 性 。 从 人 
体 解 误 学 角度 ， 得 到 上 歧 与 下 股 生 理 结构 的 定义 ， 上 上肢 为 一 构成 人 体 的 骨骼 链 ， 每 侧 由 3 块 长 骨 
与 27 块 小 骨 组 成 ， 从 习 峰 一 直 延 伸 到 臂 靖 。 上 及 不 仅 可 以 在 关 贡 处 旋转 ， 同 时 在 小 臂 部 位 其 可 以 
绕 目 映 旋转 。 其 可 以 形成 一 灵活 的 运动 链 , 依靠 肌肉 这 引 实现 所 连 肯 骨 与 手臂 胶 站 的 各 方 问 运动 。 

类 似 的 ， 下 上 股 同 样 为 一 构成 人 体 的 骨骼 链 ， 每 侧 由 3 块 长 骨 与 24 块 小 骨 组 成 ， 从 丑 部 散 
关节 一 直 延 伸 到 脚 部 股 端 。 下 上 肢 同 样 可 以 在 关 市 处 旋转 ， 同 时 在 小 腿 部 位 其 可 以 绕 目 映 旋转 ， 
形成 一 灵活 的 运动 链 ， 依 罪 肌 肉 窑 引 实现 所 连 的 骨骼 与 脚 部 股 咽 的 各 方 同 运动 。 

由 于 人 体 是 一 个 形体 和 结构 异 沼 复杂 的 生物 控制 动力 学 系 统 ， 故 只 能 对 其 进行 镜 化 。 最 
常用 的 很 具 代 表 性 的 人 体 运 动 学 模型 有 : 1964 年 Hanavan 建立 的 Hanavan 十 五 刚体 人 体 数 学 
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模型 和 1989 年 Yeadon 建立 的 由 四 十 个 环节 组 成 的 Yeadon 人 体 数 学 模型 。 
根据 “外 骨骼 ”智能 健身 与 康复 机 器 人 的 特点 ， 选 用 Hanavan 人 体 模型 ， 并 对 其 进行 简 
化 ， 分 别 得 到 了 三 刚体 构成 的 五 目 由 度 杆 件 模型 ， 如 图 9-5 所 示 。 











a) b) 
图 9-5 三 刚体 构成 的 五 目 由 度 杆 件 模型 





a) 上 及 模型 b) 下 肢 模型 

2. 人 体 消 柱 的 构造 与 运动 模型 

有 柱 为 一 构成 人 体 的 骨骼 组 ， 由 26 太 椎 骨 一 块 一 块 相聚 县 成 , 从 头骨 的 的 部 一 耳 延 伸 到 尾 
骨 。 有 有 柱 由 前 后 方 观看 ， 曲 线 为 一 百 线 ， 但 由 侧 方 观看 月 柱 有 吓 侍 的 踊 度 。 其 不 仅 承 受 人 体重 
量 ， 而 且 还 能 形成 一 灵活 的 运动 链 ， 牵 引 肌 肉 及 所 连 的 豆 官 实现 人 体 上 半 吴 的 各 方 同 运动 。 选 
用 Hanavan 人 体 模型 建立 疹 柱 模型 ， 通 过 合理 简化 得 到 一 个 二 刚体 构成 的 三 目 由 度 杆 件 模型 ， 
如 图 9-6 所 示 。 在 确定 设计 所 需 的 人 体 运 动 学 便 型 之 后 ， 对 人 体 相 关 各 部 位 的 具体 矿 寸 ， 以 及 
各 数据 随 独 身高 的 变化 规律 进行 了 文献 资料 得 阅 。 作 品 基于 Hanavan 人 体 模 型 的 各 肢体 尺寸 均 
授 照 国家 标准 GB10000 一 1988《 中 国 成 年 人 人 体 矿 二》 中 对 我 国 公民 胶体 太吉 的 质 述 所 确定 。 

:EE 
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和 
工人 








后 面 右 侧面 
图 9-6 人 体 疹 柱 结构 及 和服 干 分 区 
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3. “外 骨骼 ”机 器 人 的 工作 前 提 

根据 Hanavan 人 体 模 型 ， 在 “外 绷 髋 ”类 机 械 实际 工作 的 过 程 中 ， 机 器 “最 干 ”与 人 体 
驱 干 间 将 会 通过 背带 、 膀 带 、 授 带 分 别 固定 ， 形 成 近似 刚性 连接 的 两 个 运动 整体 ， 即 人 体 上 
红 干 与 机 占 “ 上 骤 干 ” 相 固 连 ， 人 体 下 服 干 与 机 器 “下 骤 干 ” 相 固 连 。 通 过 这 两 处 连接 ， 机 
械 “ 乳 干 ”与 人 体 驱 干 间 将 会 形成 一 个 通过 和 耐 接触 团 合 的 容 间 运动 链 ， 在 使 用 过 程 中 形成 一 
个 整体 运动 体系 。 同 时 ， 在 人 、 机 肢 干 间 固 连 的 前 提 下 ， 人 体 四 肢 与 机 右 “ 四 肢 ” 叉 将 会 形 
成 四 对 两 组 空间 中 点 闭合 的 运动 链 。 其 中 每 一 股 问 对 应 一 对 运动 链 ， 上 下 有 上肢 各 为 一 组 形式 相 
同 的 运动 链 。 在 每 个 闭合 的 运动 链 中 ， 人 体 的 股 端 〈 手 部 、 脚 部 ) 分 别 与 机 器 的 肢 亲 (手柄 、 
踏板 〉 通 过 抓 握 的 形式 ， 或 是 市 状 物 捆绑 的 形式 相连 接 。 由 于 连接 处 的 活动 量 有 限 ， 同 样 可 
以 将 此 部 位 的 连接 近似 看 作为 刚性 连接 。 为 了 满足 工作 前 提 ， 需 要 满足 如 下 要 求 : 

1) 在 机 器 人 的 整个 工作 过 程 中 ， 以 人 体 运 动 为 核心 ， 以 拟 合 人 体 运 动 为 第 一 要 务 ， 在 满 
足 机 井 人 贴 合 人 体 完 成 各 动作 的 前 提 下 , 保证 此 处 运动 链 的 运动 流畅 性 与 对 人 体 的 贴 合 性 ( 即 
机 器 人 与 人 体 两 物体 的 接触 面 在 运动 中 不 友 生 相对 滑动 、 转 动 或 分 离 )。 

2) 在 机 器 人 的 整个 工作 过 程 中 ， 保 证 机 器 “四 胶 ” 不 与 人 体 四 胶 发 生 任何 干涉 ， 以 保证 
使 用 的 舒适 性 与 安全 性 。 同 时 ， 有 上 肢 问 对 应 的 空间 团 合 运 动 链 同 样 应 你 证 运动 的 流畅 性 与 对 人 
体 的 贴 合 性 〈《 即 在 人 机 不 发 生 “ 上 肌体 干涉 ”的 前 提 下 ， 机 器 股 闹 运动 轨迹 与 人 体 股 端 运动 委 
迹 可 以 在 空间 中 拟 合 )。 

4. 人体 动作 捕捉 实验 

(1) 实验 目的 ”项 目 组 在 对 人 体 各 部 分 结构 与 运动 机 理 进行 了 较 深 入 的 了 解 后 ， 利 用 国 
内 先进 的 人 体 动作 采集 实验 军 的 实验 设备 完成 了 人 体 动作 捕捉 实验 。 

1) 采集 各 健身 动作 的 标准 动作 数据 : 利用 该 实验 的 数据 ， 可 以 为 此 产品 的 “智能 健身 教 
练 ” 功 能 提供 第 一 手 的 教学 标准 动作 资料 ， 确 定 肢 问 运动 轨迹 ， 从 而 确定 演示 与 教学 中 机 磋 
各 肢体 关节 的 控制 细节 。 

2) 获得 疹 柱 的 实际 运动 轨迹 ， 弥 补 Hanavan 人 体 模 型 对 兰 柱 运动 规律 过 度 简 化 的 缺陷 。 





















































3) 以 及 肤 为 运动 研究 对 象 ， 在 考虑 其 拉 伸 的 情况 下 ， 获 得 实际 及 肤 上 各 点 的 运动 轨迹 
(不 同 于 洽 柱 骨髓 刚体 运动 轨迹 ) ， 并 以 此 轨迹 为 基准 尽 最 大 程度 减 小 机 右 与 红 干 上 半 部 分 
间 的 滑动 。 


(2) 实验 内 容 

1) 实验 仪器 有 : (8 台 红 外 高 速 摄像 机 ， 目 带 红 外 光源 ; 包 红 外 线 反 射 球 ， 直 径 10mm， 
通过 双 面 胶带 粘贴 在 受 试 者 的 皮肤 或 紧身 衣物 上 ; 人 后 台数 据 处 理 设备 等 。 

2) 实验 对 象 。 人 体 动 作 捕捉 实验 实验 对 象 见 表 9-1。 实 验 现 场 如 图 9-7 所 示 。 


表 9-1 人 体 动作 捕捉 实验 实验 对 象 
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图 9-7 人 体 动作 捕捉 实验 现场 


3) 人 体 标 记 点 位 置 。 

QD 上肢: 肩 关 节 前 、 后 、 上 “〈 肩 峰 ) 、 外 侧 各 布置 一 个 采集 点 、 肘 关节 旋转 轴 两 侧 各 布 
置 一 个 采集 点 、 手 部 抓 担 一 长 130mm、 截 面 直 径 30mm 的 圆柱 手柄 ， 在 手柄 两 端 截面 中 心 各 
布置 一 采集 点 。 

@ 下 有 上肢: 髋 关节 前 、 后 、 外 侧 各 布置 一 采集 点 ， 上 股骨 大 转子 处 布置 一 采集 点 、 膝 关节 两 
侧 分 别 布 置 采 集 点 ， 脚 趴 前 后 转动 轴线 上 两 侧 布置 采集 点 ， 脚 掌 所 在 平面 的 前 、 后 、 左 、 碳 
四 个 边缘 位 置 分 别 布置 采集 点 。 

@) 层 干 : 在 第 一 锋 椎 、 第 七 颈椎 、 第 四 胸椎 、 第 八 胸 椎 、 第 一 腰椎 、 第 五 腰椎 、 尾 椎 处 
布置 一 列 采 集 点 ; 艇 骨 最 外 侧 布 置 一 对 采集 点 。 

4) 动作 采集 列表 见 表 9-2。 














表 9-2 动作 采集 列表 


起 始 姿态 OR 
FR 


坐位 阿 话 德 式 雪 举 坐位 屈 体 腿 抗 阻 伸 提 
了 人 向 本 起 和 这 了 TIT 


目 然 步行 数据 





(3) 数据 处 理 与 分 析 

1) 数据 品质 分 析 : 实验 通过 使 用 光学 三 坐标 测量 系统 (CNDI) 获得 了 整个 运动 采集 
过 程 中 各 采集 点 在 不 同时 刻 的 空间 绝对 坐标 (原点 在 实验 初 由 基准 设备 确定 ) 。 采 样 频率 
为 200Hz (最 高 支持 S00Hz) ， 坐 标 系 科 Z 方 向 的 精度 均 为 0.1mm。 由 于 人 体 的 遮挡 作 
用 ， 数 据 采 集 过 程 中 会 出 现 某 些 采集 点 坐标 的 暂时 性 丢失 (空白 阶段 时 长 一 般 不 超过 
0.5s) 。 由 此 造成 的 数据 空缺 通过 计算 机 目 动 插 补 补 全 。 可 信和 数据 比例 相对 于 总 体 数 据 不 
少 于 95%。 

2) 后 期 处 理 : 标记 出 数据 列表 中 各 采集 点 名 称 与 顺序 ， 在 MATLAB 软件 中 绘制 采集 点 
间 连 线 和 各 点 的 运动 轨迹 。 绘 制 轨迹 如 图 9-8 一 图 9-11 所 示 。 

从 状 柱 的 运动 轨迹 中 可 以 发 现 ， 第 一 胸椎 至 尾 椎 段 的 弯曲 主要 集中 在 腰椎 段 。 胸 椎 段 与 
贱 骨 - 尾 椎 段 基 本 呈现 出 刚性 的 状态 ,实验 数据 验证 了 Hanavan 人 体 模 型 两 刚体 颈 生 的 合理 性 ， 
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同时 为 乙 后 的 具体 机 构 设计 提供 了 坚实 的 数据 基础 。 
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图 9-8 坐姿 出 上 举 的 轨迹 图 图 9-9 ”站 姿 中 起 的 轨迹 图 





0 
500 600 ?00 800 900 1000 1100 1200 1300 1400 


图 9-10 坐位 体 前 倾 的 轨迹 图 图 9-11 站 位 体 侧 屈 的 轨迹 图 


9.3.2 机构 设计 技术 


1. 四 有 上肢 机 构 设 计 
“外 骨髓 ”智能 健身 与 康复 机 右 人 如 图 9-12 所 示 。 
(1) 四肢 机 构 设 计 思 路 ”根据 9.3.1 节 所 确定 的 人 体 模型 ， 设 计 出 如 图 9-13 所 示 的 “外 
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骨 骨 ”机 各 人 四 股 杆 件 结构 ， 并 对 人 体 模 型 进行 虚拟 造型 ， 并 与 四 股 机 构 进 行 虚 拟 动 态 拟 合 
实验 ， 验 证 机 构 设计 合理 性 。 

由 部 与 臂 部 机 架 的 设计 有 过 感 来 源 于 承载 式 车 届 ， 如 网 9-14 所 示 。 在 承载 式 车 映 中 ， 工 程 
师 们 通过 利用 不 同形 状 的 饭 金 件 ， 将 其 互相 进行 点 焊 连 接 ， 组 合成 一 体式 的 中 衬 框 以 结构 。 
这 种 结构 的 优点 ， 其 一 ， 可 以 在 中 心 部 腾 出 较 大 空间 ， 可 以 安放 各 种 设备 或 乘客 ;其 二 ， 该 














结构 又 具有 很 蜗 的 强度 和 刚性 ， 可 以 承受 外 来 的 较 大 载 傈 ， 其 三 ， 访 结构 有 效 利用 了 功能 件 
的 结构 特性 ， 充 分 发 挥 了 所 有 零件 的 结构 承载 功能 。 


FAN 





nem. 





a) b) 


图 9-12 “外 骨髓 ”智能 健 册 与 康复 机 右 人 
a) 设计 整体 效果 图 b) 实物 样机 图 





图 9-13 “外 骨骼” 机 费 人 四 股 杆 件 结构 
1 一 当量 人 体 报 干 2 一 当量 大 避 ”3 一 当量 小 辟 ”4 一 当量 手 部 (握拳 姿态 ) 5 一 机 器 人 手柄 
6 一 机 器 人 小 臂 “7 一 机 器 人 大 臂 ”8 一 大 臂 - 户 部 连接 杆 《〈 不 属于 肩 部 以 下 部 分 ) 





在 对 忆 部 及 辟 部 机 如 的 设计 中 ， 利 用 相近 的 设计 思路 ， 采 用 将 饭 金 件 〈 或 其 他 方法 成 型 
零件 ) 进行 焊接 或 进行 螺栓 连接 的 形式 。 对 于 饭 金 基体 件 ， 根 据 机 械 结构 安置 要 求 ， 结 合 其 
易 成 型 特点 ， 将 其 雪 折 成 了 类 似 于 图 9-14 中 “压板 部 件 ” 的 形状 ， 即 空间 板材 ， 同 时 ， 在 饭 
金 件 周边 通过 焊接 方式 布置 加 强 肪 ， 以 增强 机 染 承 受 各 个 方 同 冤 扭 的 能 力 ;“ 套 盘 座 ”、“ 轴 夭 
座 ”“ 电 动机 架 ” 等 功能 性 和 零件， 利用 其 不 同方 回 的 结构 特性 ， 将 其 与 机 染 结 合 ， 最 大 限度 
地 利用 这 旦 零件 的 结构 性 能 ， 以 增强 机 架 的 承载 能 力 ; 根据 增强 后 机 琳 的 承载 能 力 ， 结 合 
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动机 、 套 盘 等 零件 的 安放 位 置 需 求 ， 在 其 上 确定 安放 位 置 ， 并 在 饭 金 基体 上 设置 相应 的 铁 衬 
部 位 ， 最后， 根据 整体 机 架 (包括 轴承 座 等 附属 和 零件) 的 受 载 何 情 况 ， 在 应 力 较 小 的 部 位 设 
轩 相 应 胞 匀 空 孔 。 





项 盖 





”底板 前 纵 梁 
承载 式 轿车 车 身 壳 体 零件 分 解 图 


图 9-14 四肢 机 架设 计 思 路 示意 图 


(2) 四 胶结 构 的 具体 设计 
1) 手臂 整体 结构 示意 图 如 图 9-15 所 示 。 





图 9-15 手 锅 整体 结构 示意 图 
1 一 第 一 动力 模块 ”2 一 第 二 动力 模块 ”3 一 第 三 动力 模块 4 一 手 部 伸 长 部 件 ”5 一 大 臂 管 《上 及 部 分 包括 第 一 动力 模块 、 








第 二 动力 模块 、 第 三 动力 模块 、 大 臂 管 和 手 部 伸 长 部 件 ， 其 中 大 臂 管 为 直角 结构 ) 
2) 第 一 动力 模块 。 第 一 动力 模块 包括 饭 金 基体 A、 饭 金 A、 饭 金 B、 骨 机 A、 舵 机 B、 
圆柱 齿轮 A、 圆 柱 齿轮 B、 轴 B、 轴 承 座 B、 锥 齿轮 A、 锥 齿轮 B、 轴 承 座 A 和 轴 A。 其 连接 
关系 为 ; 饭 金 A 和 饭 金 B 固 接 在 饭 金 基体 A 上 形成 双 层 台阶 式 的 基 座 , 艇 机 A 通过 固定 在 基 
座 的 上 层 表 面 ， 锥 齿轮 A 与 舵 机 A 的 码 盘 连接 ， 其 中 锥 齿轮 A 的 轴线 处 于 竖 直 方向 。 锥 齿轮 
A 和 轴线 与 其 垂直 的 锥 齿轮 B 路 合 ; 锥 齿轮 B 与 轴 A 固 接 ， 轴 A 位 于 舵 机 A 的 正 下 方 ， 即 
轴 A 动力 输出 的 方 回 为 水 平 回 后 。 轴 A 通过 轴承 与 轴承 座 A 配合 ， 轴 承 座 A 与 基 座 连接 。 能 
机 B 固定 在 基 座 的 下 层 表面 上 上， 圆柱 此 轮 A 与 和 能 机 了 的 码 盘 连接 ， 圆 柱 齿 轮 A 与 圆柱 齿轮 B 
叶 合 ， 其 中 圆柱 齿轮 A 和 圆柱 齿轮 B 的 轴线 均 处 于 竖 直 方 问 ; 圆柱 齿轮 A 与 轴 B 连接 ， 轴 也 B 
动力 输出 的 方 回 为 竖 直 问 下 。 轴 B 通过 轴承 与 轴承 座 B 配合 ， 轴 承 座 B 固定 在 基 座 上 。 其 结 
构 示 意图 分 别 如 图 9-16 一 图 9-18 所 示 。 
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图 9-16 第 一 动力 模块 结构 示意 图 1 
1 一 饭 金 基体 A ”2 一 饭 金 A 3 一 饭 金 B 4 一 稻 机 A 5 一 稻 机 B 6 一 圆柱 齿轮 A 
7 一 圆柱 齿轮 B ”8 一 轴承 座 B 9 一 锥 齿轮 A 10 一 锥 齿轮 B 





2 


图 9-17 第 一 动力 模块 结构 示意 图 2 图 9-18 第 一 动力 模块 结构 示意 图 3 


1 一 轴 B 2 一 轴承 座 A 1 一 轴 A 


3) 第 二 动力 模块 。 第 二 动力 模块 包括 饭 金 基体 B、 饭 鲍 C、 饭 金 D、 骨 机 C、 圆 柱 齿 轮 
C、 圆 柱 齿轮 D、 轴 C 和 轴承 座 C。 其 各 部 分 的 连接 关系 为 : 饭 金 基体 B、 饭 金 C 和 饭 金 D 
国 连 形成 第 二 动力 模块 的 基 座 ;， 艇 机 C 固定 在 基 座 上 。 圆 柱 齿 轮 C 固定 在 舵 机 CC 的 码 盘 上 ， 
圆柱 齿轮 D 与 圆柱 齿轮 C 嘴 合 ， 其 中 圆柱 齿轮 C 和 圆柱 齿轮 D 的 轴线 均 处 于 竖 直 方向 。 圆 柱 
齿轮 DD 与 轴 C 固 接 ， 轴 C 的 竖 直 同 下 输出 动力 。 轴 CC 通过 轴承 与 轴承 座 C 配合 ， 轴 承 座 C 
固定 在 基 座 上 。 其 结构 如 图 9-19 和 图 9-20 所 示 。 























图 9-19 第 二 动力 模块 结构 示意 图 1 
1 一 饭 金 基体 B 2 一 饭 金 C 3 一 饭 金 D 4 一 盘 机 C 5 一 圆柱 齿轮 C 
6 一 圆柱 齿轮 D 7 一 轴承 座 C 
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图 9-20 ”第 二 动力 模块 结构 示意 图 2 
1 一 轴 C 


4) 第 三 动力 模块 。 第 三 动力 模 芯 包括 饭 金 基板 C、 骨 机 D、 锥 齿轮 C、 锥 齿轮 D、 轴 D 
和 轴承 座 D。 其 各 部 分 的 连接 关系 为 : 饭 金 基板 C 为 第 三 动力 模块 的 基 座 ， 能 机 D 固定 在 饭 
金 基 板 C 的 上 表面 ， 锥 齿轮 C 与 骨 机 D 的 人 码 盘 固 接 ， 其 中 锥 次 轮 C 的 轴线 处 于 紧 直 方向 。 锥 
齿轮 C 和 轴线 与 其 垂直 的 锥 贞 轮 D 路 合 ， 锥 齿轮 D 与 轴 D 固 接 , 轴 D 位 于 此 机 了 的 正 下 方 ， 
即 轴 D 水 平 向 后 输出 动力 。 轴 D 同时 通过 轴承 与 轴承 座 D 配合 ， 轴 承 通 过 轴承 座 盖 与 轴承 座 
D 压 案 ， 轴 承 座 D 固定 在 饭 金 基板 C 下 表面 。 其 结构 如 图 9-21 所 示 。 

















图 9-21 第 三 动力 模块 结构 
a) 示意 图 1 b) 示意 图 2 
1 一 饭 金 基板 C， 2 一 盘 机 D 3 一 锥 齿轮 C 4 一 锥 齿轮 D 5 一 轴 D 6 一 轴承 座 D 
功能 模块 虚拟 建 模 如 图 9-22 所 示 。 
手 部 伸 长 部 件 包 括 小 臂 大 套 管 、 锁 紧 调 位 机 构 A、 小 臂 直 党、 小 臂 折 共管 、 手 柄 工 管 、 

















手柄 旋转 轴 、 手 柄 分 又 和 手柄 套 管 。 其 各 部 分 的 连接 关系 为 : 小 臂 大 套 管 为 直角 结构 ， 其 
坚 下 部 分 的 痹 部 通过 锁 案 调 位 机 构 A 与 小 名 和 直 壳 连接 , 小 避 直 管 的 态 一 哨 通 过 直角 过 管 与 











小 臂 折 膏 管 连接 ; 小 臂 折 雪 管 的 另 一 闫 和 轴线 与 其 牌 直 的 手柄 工 管 连接 。 手 柄 工 管 的 上 英 
连接 手柄 分 又 ， 手 柄 分 叉 为 U 形 结构 ， 手 顶 分 又 的 左右 两 新 之 间 安 装 手柄 心 管 ， 手 顶 心 管 
外 和 套 半 橡胶 制 的 手柄 套 管 。 手 柄 心 管 的 网 个 端面 分 别 安 装 有 手柄 问 盖 ;手柄 旋转 轴 和 套装 在 
手柄 工 管内 ; 在 手柄 分 又 与 手柄 工 管 的 连接 处 ， 手 柄 分 又 与 手柄 旋转 轴 和 连接 。 其 结构 如 图 
9-23 所 示 。 

锁 紧 调 位 机 构 A 的 具体 结构 为 : 小 臂 直 管 僚 在 小 臂 大 套 管 中 ， 在 小 臂 大 套 管 内 部 与 小 臂 
直 管 的 连接 问 有 两 个 相对 安 儿 的 人 花 型 松 楷 环 ， 在 小 臂 直 管 上 和 小 臂 大 套 管 的 连接 问安 厂 有 沉 
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头 螺钉 ， 沉 头 螺 钉 的 螺钉 头 未 完全 沉 入 管 壁 ， 即 沉 头 螺钉 在 管 壁 上 有 凸 起 ， 同 时 在 小 臂 大 套 
管 的 内 盛 加 工 有 与 沉 头 螺 杀 上 的 凸 起 相对 应 的 直 棺 。 其 结构 如 图 9-24 所 示 。 

手 部 模块 的 整体 连接 关系 为 : 手 部 仲 长 部 件 中 小 辟 大 套 礼 水 平 部 分 的 器 部 与 第 一 动力 模 
块 中 轴 B 的 动力 输出 疾 连 接 ， 第 一 动力 模块 中 轴 A 的 动力 得 出 站 与 大 辟 管 的 一 中 连接 ， 大 崩 
管 的 万 一 站 与 第 二 动力 模块 中 轴 C 的 动力 输出 咒 连 接 ; 第 三 动力 模块 中 轴 D 的 动力 输出 端 与 
第 二 动力 模块 的 基 座 连接 ， 第 三 动力 模块 驱动 第 二 动力 模块 整体 转动 。 




















图 9-23 手 部 伸 长 部 件 机 构 示 意图 图 9-24 锁 罕 调 位 机 构 A 结构 示意 图 
1 一 小 臂 大 套 管 ”2 一 锁 紧 调 位 机 构 A ”3 一 小 臂 直 管 9 一 松紧 环 锁 紧 扣 ”10 一 花 型 松紧 环 ”11 一 沉 头 螺钉 
4 一 小 臂 折 弯 管 5 一 手柄 了 管 6 一 手柄 旋转 轴 12 一 凹 槽 ”13 一 直 模 


7 一 手柄 分 又 ”8 一 手柄 套 管 
脚 部 模块 包括 第 四 动力 模块 、 第 五 动力 模块 、 第 六 动力 模块 、 第 七 动力 模块 、 大 腿 省 、 
脚 部 伸 长 部 件 和 足 部 部 件 。 其 中 大 腿 管 为 下 角 结 构 : 第 四 动力 模块 与 第 一 动力 模块 结构 相同 ， 
第 六 动力 模块 与 第 三 动力 模块 结构 相同 ， 第 五 动力 模块 与 第 七 动力 模块 均 和 第 二 动力 模块 结 
构 相 同 。 其 结构 如 图 9-25 所 示 。 
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图 9-25” 脚 部 模块 结构 示意 图 
1 一 第 四 动力 模块 ”2 一 第 五 动力 模块 。 3 一 第 六 动力 模块 4 一 第 七 动力 模块 
5 一 脚 部 伸 长 部 件 “6 一 大 腿 管 ”7 一 足 部 部 件 

脚 部 伸 长 部 件 包 括 小 腿 大 套 管 、 小 腿 直 管 、 锁 么 调 位 机 构 B 和 小 腿 砌 病 连 接 件 。 其 中 锁 
崇 调 位 机 构 B 与 锁 紧 调 位 机 构 A 的 结构 相同 ; 小 腿 大 套 管 紧 直 部 分 的 站 部 通过 锁 系 调 位 机 构 
B 与 小 腿 百 各 连接 ， 小 腿 直 和 的 万 一 中 与 小 腿 撒 器 连接 件 相连 。 足 部 部 件 包 括 足 部 饭 金 、 塑 料 
板 和 橡胶 热 ， 其 中 足 部 饭 金 紧 赴 放置， 塑料 板 和 橡胶 垫 均 水 平 放 置 ， 足 部 饭 金 与 塑料 板 连 接 ， 
塑料 板 与 橡胶 热 7 连接 。 其 结构 如 图 9-26 所 示 。 足 部 部 件 结构 如 网 9-27 所 示 。 

















图 9-26 脚 部 伸 长 部 件 结构 示意 图 图 9-27 足 部 部 件 结构 示意 图 
1 一 小 腿 大 套 管 ”2 一 小 腿 直 管 3 一 锁 紧 调 位 机 构 B 5 一 足 部 饭 金 ”6 一 塑料 板 7 一 橡胶 执 


4 一 小 腿 底 端 连接 件 
脚 部 模块 的 整体 连接 关系 为 :， 足 部 部 件 中 足 部 饭 金 的 项 部 与 第 五 动力 模块 的 动力 输出 轴 
连接 ， 第 五 动力 模块 的 基 座 与 脚 部 伸 长 部 件 中 的 小 腿 撒 端 连 接 件 相连 。 小 腿 大 套 管 水 平 部 分 
的 端 部 与 第 四 动力 模块 的 竖 直 动力 输出 轴 连 接 ， 第 四 动力 模块 的 水 平 动力 输出 轴 与 大 腿 管 的 
一 闹 连 接 ， 大 民 管 的 力 一 并 与 第 七 动力 模块 的 动力 输出 轴 连 接 。 第 六 动力 模块 的 动力 输出 轴 
与 第 七 动力 模块 的 基 座 连接 ， 第 六 动力 模块 驱动 第 七 动力 模块 整体 转动 。 
需要 特别 说 明 的 是 ， 为 了 对 小 臂 直 管 的 位 置 进行 定量 调节 ， 在 小 崩 直 管 上 安装 沉 头 螺钉 
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的 位 置 沿 其 外 圆周 面 加 工 止 槽 ， 当 小 臂 直 管 抒 入 后 ， 可 以 通过 小 臂 大 套 管 上 的 观察 孔 观 察 目 
覃 的 位 置 进而 判断 小 臂 直 管 在 小 臂 大 套 管 内 的 相对 位 置 。 

(3) 各 张 动 单 元 轴 系 的 设计 “驱动 单元 中 轴 系 设计 是 难点 也 是 关键 点 ， 在 设计 过 程 中 需 
要 考虑 强度 、 承 载 能 力 、 体 积 、 重 量 、 各 元 件 配 合 尺 寸 等 各 方面 因素 。 肘 部 和 肩 部 驱动 单元 
轴 系 分 别 如 图 9-28 和 图 9-29 所 示 。 


NAN 轴承 肘 部 心 轴 1 号 饭 金 件 
轴承 调整 垫 片 A = a / 


齿轮 园 久 














图 9-29 ” 肩 部 驱动 模块 轴 系 设计 示意 图 








在 所 有 驱动 模块 中 ， 圆 柱 齿 轮 组 型 号 分 别 为 2m、14 具 与 2m、26 齿 ， 齿 宽 6mm; 所 有 圆 
锥 齿轮 副 分 别 为 lm、18 此 与 2m、36 齿 ， 上 直面 宽 6mm。 


2. 腰部 机 构 设 计 


(1) 腰部 机 构 设计 思路 ” 腰 背 运动 结构 的 设计 一 直 是 人 体 随 动 机 构 设 计 的 一 大 难题 。 本 
作品 所 设计 的 背部 8R 空间 连 杆 机 构 在 结构 方面 实现 了 较 大 的 创新 , 该 结构 的 采用 使 机 如 人 能 
够 实现 前 后 、 左 右 双 目 由 度 的 运动 ， 因 而 可 实现 对 腰 背 部 绝 大 多 效 肌肉 群 的 锻炼 : 包括 腹 下 
肌 、 腹 横 肌 及 腹 外 和 斜 肌 。 同 时 该 结构 只 需 4 个 驱动 装置 便 可 完成 所 有 动作 ， 不 仪 市 省 空间 、 
减轻 重量 ， 强 化 了 功能 ， 更 有 效 降 低 了 由 于 高 性 能 张 动 元 件 帝 来 的 成 本 。 

“外 骨骼 ”智能 健身 与 康复 机 器 人 的 腰痛 部 机 构 简 图 和 虚拟 样机 网 如 图 9-30 所 示 。 

为 适应 不 同 号 材 的 使 用 者 ， 在 腰 背 部 设计 有 长 度 调 布 机构 ， 其 机 构 简 几 如 图 9-31 所 示 。 

(2) 腰部 机 构 运 动 规律 分 机 ”根据 “人 体 动 作 捕 欣 实验 ”所 得 实验 数据 ， 进 行 腰 部 机 构 
运动 规律 分 析 。 通 过 绘制 人 体 运动 轨迹 ， 进 行 运动 学 分 析 ， 以 校 核 消 柱 理 论 模型 并 修整 腰部 
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机 构 设计 参数 。 腰 背部 机 构 侧 届 和 前 居 动 作 轨迹 拟 合 网 如 网 9-32 和 图 9-33 所 示 。 
根据 运动 学 分 析 结 来， 所 设计 腰部 机 构 设置 可 以 精确 拟 合 人 体 有 有 柱 侧 届 动 作 的 运动 轨迹 。 
由 以 上 运动 学 拟 合 分 析 结 来 可 见 ， 该 机 构 设 置 可 以 拟 合 人 体 消 柱 前 届 动 作 的 运动 轨迹 。 


4 庙 


b) 








图 9-30 ” 腰 缘 部 运动 机 构 
a) 机 构 简 图 b) 虚拟 样机 图 


图 9-31 长 度 调节 机 构 机 构 简 图 
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a) b) 


图 9-32 ” 腰 彰 部 机 构 侧 居 劲 作 轨 迹 拟 合 图 
a) 侧 届 运 动 重 心 轨迹 拟 合 图 〈 正 面 ) b) 侧 届 运 动 重心 轨迹 拟 合 图 (侧面 ) 
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a) 腰 背 部 结构 简化 模型 的 前 屈 运 动 b) 人 体 前 届 运 动 拟 合 图 c) 腰 背 i 
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Cc) 





9-32 ” 腰 背 部 机 构 侧 届 动 作 轨迹 拟 合 图 〈 续 ) 
c) 人 体 侧 届 运动 拟 合 图 d) 腰 背 部 机 构 简化 模型 的 侧 届 运动 图 
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Cc) 
图 9-33 ” 膀 背 部 机 构 前 屈 动 作 轨 迹 拟 合 图 
背部 机 构 前 届 动 作 轨 迹 重心 轨迹 拟 合 图 





(3) 腰 背 部 设计 细 市 ” 骤 干 模块 背面 结构 示意 图 如 图 9-34 所 示 。 
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图 9-34 ” 驱 干 模块 背面 结构 示意 图 
1 一 肚 部 基板 ”2 一 腰部 舵 机 固定 架 ”3 一 租 机 EE 4 一 腰部 驱动 连 杆 A ”5 一 腰部 驱动 连 杆 B 6 一 辟 部 承重 连 杆 





7 一 辟 部 承重 杆 前 端 盖 ” 8 一 肩 部 饭 金 基体 ”9 一 丝 枉 “10 一 丝 杠 端 套 A ”11 一 丝 杠 端 套 B 
12 一 步 进 电动 机 ”13 一 腰部 大 套 盘 ”14 一 衣 部 承重 套 杆 ”15 一 租 机 F 16 一 背部 上 端 承重 杆 
17 一 腰部 上 部 承重 连 杆 ”18 一 腰部 大 套 盘 转动 撑 杆 “19 一 肩 部 跨越 件 

典 干 模块 包括 腰部 系统 和 背部 系统 。 

1) 腰部 系统 包括 臂 部 基板 、 腰 部 此 机 固定 杂 、 堪 侧 腰部 机 构 和 右 侧 腰部 机 构 。 腰 部 艇 机 
国定 杂 回 定 在 辟 部 基 尺 下 站， 并 治 辟 部 基板 的 紧 直 中 心 线 左 右 对 称 ， 坞 侧 腰部 机 构 和 右 侧 腰 
部 机 构 在 辟 部 基板 上 左右 对 称 布 早 ， 下 和 面 仪 以 左 侧 腰 部 机 构 为 例 其 体 介 绍 其 结构 。 

左 侧 腰部 机 构 包 括 艇 机 卫 、 腰 部 驱动 连 杆 A、 腰 部 驳 动 连 杆 B、 臂 部 承重 连 杆 、 避 部 承重 
竹 利 辟 部 承重 杆 击 闹 击 。 其 中 辟 部 承重 连 杆 为 半圆 形 结构 ， 访 半圆 形 结构 的 对 称 线 沿 水 平方 
问 ， 导 部 承重 连 杆 有 三 个 分 文 ， 分 别 位 于 半圆 形 络 构 的 顶部 、 辰 部 及 外 圆周 ， 其 中 外 圆周 上 
的 分 文 位 于 其 水 平 对 称 线 的 位 置 。 远 侧 腰部 机 构 的 具体 连接 关系 为 : 及 机 E 固定 在 腰部 能 机 
固定 架 的 堪 侧 ， 能 机 卫 的 输出 轴 与 膀 部 驱动 过 杆 A 相连 ， 腰 部 张 动 连 杆 A 的 号 一 端 与 腰部 张 
动 连 杆 B 动 连接 ， 腰 部 张 劲 连 杆 B 的 万 一 中 与 臂 部 承重 连 杆 外 圆周 上 的 分 文 连接 。 

在 臂 部 基板 上 腰部 能 机 固定 架 上 方 ， 加 工 有 臂 部 承重 轴 的 安 净 扎 ;等 部 涉 重 灿 通 过 轴承 
安装 在 该 安装 筷 内 ， 丑 部 承重 轴 的 一 问 与 展 部 承重 连 杆 底部 的 分 文 固 连 ， 为 一 端 穿 过 民 部 基 
板 与 绒 部 轴承 座 动 连接 ， 丑 部 轴承 座 固 定 在 辟 部 基板 上 。 壁 部 承重 轴 与 辟 部 轴承 座 连 接 的 一 
病 同 时 与 臂 部 承重 杆 前 端 产 回 连 ; 辟 部 承重 连 杆 项 部 的 分 文 与 至 部 系统 相连 。 

2) 背部 系统 包括 肩 部 饭 金 基体 、 丝 枉 、 丝 杠 端 套 A、 丝 杠 端 套 B、 步 进 电动 机 、 左 部 运 
动机 构 与 右 部 运动 机 构 。 

屑 部 锯 金 基体 为 堪 右 对 称 结构 ， 在 其 竖 直 中 心 线 上 加 工 有 经 杠 安 疙 杠 ， 丝 杠 通 过 其 项 部 
的 丝 杠 端 套 A 和 帮 部 的 丝 枉 端 套 B 竖 百 安 效 在 丝 杠 安装 梢 内 。 丝 杠 病 套 A 和 丝 杠 疹 余 B 的 
外 圆周 分 别 安 疙 有 轴承 和 轴承 座 ， 所 述 和 轴承 座 固定 在 局 部 饭 金 基体 上 。 背 动 天 安 站 在 经 灶 上， 
清 动 块 与 丝 林 配合， 可 治 丝 本 上 下 移动 。 步 进 电动 机 的 得 出 轴 与 丝 杠 的 顶部 相连 ; 均 部 运动 
机 构 与 右 部 运动 机 构 沿 丝 杠 左右 对 称 ， 下 面 仅 以 无 部 运动 机 构 为 例 其 体 介绍 其 结构 。 

左 部 运动 机 构 包 括 采 部 大 套 可 、 屑 部 承重 人 套 村 、 骨 机 F、 背 部 上 噶 承重 杆 、 肩 部 套 杏 座 、 
腰部 怪 轴 前 站 兰 、 惧 部 下 端 承重 传动 轴 、 腰 部 怪 轴 、 腰 部 上 部 承重 连 杆 和 腰部 大 套 盘 转动 择 
杆 。 其 中 腰部 上 部 承重 连 杆 为 下 角 结 构 ， 该 直角 结构 水 平 部 分 的 中 部 有 竖 二 站 下 的 连接 座 。 


© 







































































大 学 生 课 外 科技 创新 竞赛 获奖 作品 精 析 


左 部 运动 机 构 各 部 分 之 间 的 连接 关系 为 : 辟 部 承重 连 杆 项 部 的 分 文 与 腰部 上 部 承重 连 杆 上 的 
连接 座 动 连接 ;同时 腰部 上 部 承重 连 杆 上 的 连接 座 与 辟 部 承重 杆 前 问 兰 固 连 。 腰 部 上 部 承重 
连 杆 竖 直 部 分 上 端的 外 侧 固 定 有 艇 机 F，~ 艇 机 下 的 码 盘 与 肩 部 下 端 承重 传动 轴 固 连 。 肩 部 下 端 
承重 传动 轴 与 背部 上 端 承 重 杆 连接 ， 背 部 上 端 承 重 杆 套装 在 肩 部 承重 套 杆 表面 的 滑 槽 内， 从 
而 形成 一 个 滑 槽 结构 ， 相 互 只 能 沿 滑 槽 方 同 运动 。 

在 居 部 饭 金 基体 上 ， 丝 杠 的 右 侧 加 工 有 腰部 大 套 盘 的 安 厂 孔 ， 腰 部 大 套 盘 位 于 该 安装 孔 
内 。 腰 部 大 套 盘 与 腰部 大 套 盘 转动 撑 杆 动 连接 ， 腰 部 大 套 盘 转动 撑 杆 的 另 一 问 与 滑动 件 动 连 
接 。 同 时 腰部 大 套 盘 的 另 一 端 穿 过 习 部 饭 金 基体 与 恨 部 依 盘 座 动 连接 ， 恨 部 僚 盘 座 与 恨 部 饭 
金 基 体 固 连 。 在 腰部 大 套 盘 上 加 工 有 腰部 已 轴 的 安装 和 孔 ， 腰 部 已 轴 安装 在 安装 和 孔 内 ， 并 与 腰 
部 大 套 盘 动 连接 。 腰 部 心 轴 的 一 端 与 恨 部 承重 套 杆 的 问 部 连接 ， 另 一 问 罕 过 腰部 大 套 盘 与 腰 
部 已 轴 前 端 盖 回 连 。 骤 干 模块 正面 结构 示意 图 如 图 9-35 所 示 。 

由 于 左 部 运动 机 构 和 右 部 运动 机 构 的 肩 部 承重 套 杆 在 肩 部 饭 金 基体 上 交叉 安装 ， 为 了 保 
证 两 边 的 运动 机 构 互 不 干涉 ， 右 部 运动 机 构 的 习 部 承重 套 杆 则 通过 忆 部 路 越 件 与 位 于 恨 部 饭 
金 基 体 上 丝 杠 左 侧 的 腰部 必 轴 固 连 。 腰 部 必 轴 的 训 视 独 如 网 9-36 所 示 。 悄 部 承 曾 僚 杆 处 的 剖 
视图 如 图 9-37 所 示 。 

整体 连接 关系 为 : 两 个 手 部 模块 分 别 通 过 各 日 第 三 动力 模块 的 基 座 固 接 在 绒 干 模块 中 肩 
部 饭 金 基体 的 左右 两 侧 ， 两 个 脚 部 模块 分 别 通过 各 目 第 六 动力 模块 的 基 座 固 接 在 躯干 模块 中 
丑 部 基板 的 左右 两 侧 ， 两 个 手 部 模块 、 两 个 脚 部 模块 及 绒 干 模块 间 的 运动 相互 独立 。 





































































































图 9%-3$ ”躯干 模块 正面 结构 示意 图 
1 一 腰部 舵 机 固定 架 ”2 一 租 机 E 3 一 辟 部 承重 连 杆 4 一 辟 部 承重 杆 前 端 盖 ”5 一 肩 部 饭 金 基体 
6 一 般 机 F 7 一 肩 部 套 盘 座 ” 8 一 腰部 芯 轴 前 端 盖 ”9% 一 腰部 上 部 承重 连 杆 








图 9-36 ”腰部 必 轴 处 的 训 视 图 


1 一 腰部 蕊 轴 前 端 盖 ”2 一 腰部 心 轴 3 一 屑 部 跨越 件 
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图 9-37 户 部 承重 套 杆 处 的 剖 视 图 
1 一 启 部 承重 套 杆 ”2 一 般 机 F 3 一 背部 上 端 承 重 杆 4 一 肩 部 下 端 承重 传动 四 


3. 润滑 与 密 圭 

由 于 考虑 到 该 作品 工作 地 点 为 家 峰 住 宅 及 健 映 房 等 室内 场所 ， 其 周边 环境 往往 需要 你 持 
清洁 。 液 体 润滑 剂 尽 官 具 有 很 好 的 润 消 与 敌 热 效果 ,但 因 其 流动 性 太 强 ， 可 能 会 造成 对 周边 
环境 的 污染 同时， 液体 润滑 剂 可 能 引起 菜 些 非 金属 塑料 零件 的 变形 。 因 此 ， 该 作品 所 有 活 
动 部 位 的 润滑 采用 固体 润 靖 方式 ， 即 脂 油 滑润 滑 方式 。 对 于 张 动 单元 轴 系 中 的 轴 藉 ， 选 用 塑 
料 轴承 专用 润滑 脂 洞 滑 。 对 于 其 余 逆 有 特 氟 龙 润 清 套 的 轴 ， 与 肩 部 的 清 轨 ， 选 用 特 “ 氟 龙 酒 
滑 脂 ”《 主 要 成 分 为 特 氟 龙 粉 末 与 笛 化 剂 ) 进行 润滑 。 其 原因 在 于 : 呈 该 洞 滑 脂 的 有 效 成 分 
与 润 清 套 的 材料 相同 ， 无 需 担 心 互相 的 化 学 变性 反应 ; 包 访 润 请 脂 具 有 较 强 的 附 看 能 力 ， 可 
以 在 导轨 间 形 有 效 成 持久 的 润 讲 膜 ， 包 该 润 清 脂 性 价 比 高 ， 售 价 仅 为 40 元 /100 元 ， 符 合 经 济 
侍 要 求 。 






































9.3.3 ”控制 与 驱动 系统 


“外 骨骼 ”智能 健身 与 康复 机 器 人 的 控制 系统 由 嵌入 式 控制 模块 和 上 位 机 控制 系统 两 个 
层级 组 成 。 先 入 式 控制 模块 采用 意 法 半导体 公司 的 
STM32 作为 主 控 芯片 , 实现 电动 机 轨迹 控制 算法 ， 并 通 
过 串口 通信 与 通信 模块 和 电动 机 驱动 模块 进行 控制 信 
号 与 反馈 信号 传递 。 机 器 人 功能 的 实现 需要 对 22 个 能 
机 的 位 置 和 速度 完成 闭环 控制 ， 使 得 机 器 人 能 够 精确 拟 
合 人 体 运 动 轨迹 ， 实 现 健身 、 康 复 牵 引 功能 及 标准 运动 
姿势 教学 功能 。 当 机 器 人 实现 健身 功能 时 ， 需 要 通过 控 
制 舵 机 提供 阻力 和 矩 来 达到 健身 运动 的 目的 ， 嵌 入 式 控制 
模块 将 对 舵 机 输出 力矩 进行 控制 ， 使 得 力矩 的 输出 符合 
人 体 运 动工 程 学 规律 。 上 位 机 控制 系统 包括 PC 控制 界 
面 、 移 动 设 备 控制 终端 和 显示 设备 。 利 用 上 位 机 实现 对 
“外 骨骼 ”机 器 人 本 体 的 模式 转换 、 功 能 设置 等 功能 ， 
在 显示 设备 中 可 直接 显示 出 各 驱动 电动 机 的 位 置 、 速 度 
与 输出 力矩 ， 结 合 PC 机 的 显示 屏 和 手机 、 平 板 电脑 等 
移动 设备 的 屏幕 ， 实 现 对 “外 骨骼 ”机 器 人 动作 的 动态 
展示 。 控 制 系 统 框 图 如 图 9-38 所 示 。 图 9-38 ”控制 系统 框图 
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1. 了 驱动 系统 与 算法 设计 

采用 高 性 能 、 大 力 算 直流 伺服 电动 机 作为 驱动 元 件 ， 可 同时 提供 健 吴 所 需 的 运动 阻力 和 
康复 所 需 的 率 引 动力 。 采 用 位 置 环 、 速 度 环 、 力 矩 环 的 反馈 陈 张 动 控 制 ， 使 机 右 人 各 构件 在 
健 且 或 康复 过 程 中 实现 迷 准 且 迅 速 的 运动 ， 且 能 同时 实现 对 运动 速度 、 张 动 扭 矩 〈 力 度 ) 的 
任意 调整 。 这 一 特性 改变 了 传统 健身 器 械 需 要 重 物 或 弹性 元 件 捉 供 阻力 的 思维 定式 ， 可 以 在 
健身 /康复 过 程 中 为 各 构件 提供 所 需要 的 阻 /动力 与 速度 ， 即 使 在 一 组 动作 中 也 可 以 实现 阻力 的 
相应 变化 ， 不 受 外 界 因素 制约 。 

由 于 本 作品 是 以 施加 人 体 运 动 的 阻力 或 动力 ， 从 而 分 别 起 到 健身 与 康复 牵引 的 功能 ， 这 
束 对 电动 机 的 力 窍 和 冲 量 控制 提出 了 要 求 。 为 精确 拟 合 人 体 运动 轨迹 ，3 引 入 四 阶 闭环 PID 控 
制 算 法 以 实现 对 电动 机 高 精度 控制 ， 其 框图 如 网 9-39 所 示 。 









































图 9-39 ”驱动 控制 算法 框图 
鉴于 本 作品 在 运作 过 程 中 是 跟随 人 体 进行 随 动 运动 ， 并 依 徘 作品 运动 末端 与 人 体 产 生 互 














动 ， 从 而 实现 健身 与 康复 功能 。 考 虑 到 互动 过 程 中 的 顺畅 性 、 和 舒适 性 和 运动 轨迹 拟 合 的 展 好 
性 ， 需 对 作品 的 运动 轨迹 进行 规划 ， 而 传统 的 直线 插 补 或 低 次 插 补 算法 虽然 简单 易 行 ， 但 无 
法 满足 本 作品 的 要 求 。 为 此 ， 在 运动 轨迹 规划 中 引入 了 五 次 样 条 曲线 插 补 算法 ， 对 伺服 舵 机 
的 速度 轨迹 和 加 速度 轨迹 进行 规划 。 避 人 免 由 于 采用 直线 插 补 或 低 次 插 补 算法 市 来 的 运动 轨迹 
衔接 处 无 法 保证 良好 精度 要 求 等 竞 端 。 

2. 基于 STM32 必 片 的 硬件 电路 开发 

针对 系统 高 实时 性 和 高 可 靠 性 的 要 求 ， 能 入 式 控 制 系统 以 STM32F103VET6 为 控制 核心 。 
实现 以 ARM CortexIM-M3 为 内 核 的 高 性 能 、 低 成 本 、 低 功 耗 的 藤 入 陈 欣 制 系统 的 开发 ， 并 辅 
以 RS485 伺服 指令 总 线 、RS232 系统 级 通信 接口 及 通信 息 线 、PWM 波 发 生 模块 等 功能 模块 。 
基于 STM32 心 斤 的 便 件 电路 诛 理 网 与 实物 网 分 别 如 网 9-40 和 图 9-41 所 示 。 

3. 软件 系统 设计 与 开发 

(1) 上 位 机 调试 软件 的 编写 基于 Windows 的 MFC 编程 ， 自 主 开发 了 调试 软件 。 考 虑 
到 MFC 以 C++ 类 的 形式 封装 了 Windows 的 API， 并 且 包 含 一 个 应 用 程序 框架 ， 可 以 减少 应 用 
程序 开发 人 员 的 工作 量 。MFC 包含 大 量 Windows 句柄 封装 类 和 很 多 Windows 的 内 建 控件 和 
组 件 的 封装 类 ， 借 用 这 些 类 封装 和 控件 ， 在 C++ 环境 下 编写 了 调试 应 用 程序 ， 上 位 机 调试 程 
序 如 图 9-42 所 示 。 

(2) 通信 协议 ”根据 散 入 式 控制 系统 对 艇 机 的 控制 需求 ， 并 针对 通信 语义 语法 的 可 读 写 
性 强 、 简 单 明 了 的 特点 ， 设 计 过 程 中 对 上 下 位 机 之 间 和 骨 入 式 控制 系统 与 驱动 元 件 骨 机 之 间 
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的 串 行 通信 协议 进行 了 目 定义 。 通 过 目 定 义 的 通信 协议 ， 实 现 对 通信 双方 的 数据 传送 进行 约 
定 。 约 定 中 包括 对 数据 格式 、 同 步 方式 、 传 送 速 度 、 传 送 步 又 、 检 碍 纠 错 方式 及 控制 字符 定 
义 等 问题 做 出 统一 规定 ， 通 信 双 方 共同 章 守 。 网 9-43 所 示 为 有 机 间 的 通信 协议 。 
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图 9-40 ”硬件 电路 原理 图 
图 9-40” 便 件 电路 原理 图 
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图 9-41 硬件 电路 实物 图 
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图 9-43 中 ， 


图 9-42 ”上 位 机 调试 程序 


InNnstruction Packet 


Instruction Packet is command data that lain Gontroller sends to Dynamixel. 


The structure of Instruction Packet is as follows: 


[OXFF DxFF| liol LENGTH INSTRUCTION PARAMETER1 -PARAMETER NM |CHECK SUM 
图 9-43 ”能 机 间 的 通信 协议 
各 字符 合 义 为 : 


1) OXFF 0XFF: 帧 头 。 

2) ID: 能 机 的 ID 编号 。 

3) LENGTH: 该 帧 长 度 。 

4) INSTRUCTION: 命令 名 。 

5) PARAMETER: 对 应 命令 的 参数 。 

6) CHECK SUM: 校 验 帧 。 

上 位 机 与 下 位 机 的 通信 协议 如 图 9-44 ET 


本 
uniock D2 [oor [am] [oor EE I 
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ID 1 ID2 ID 22 


H: High byte of Goal Position 
L: Low byte of Goal Position 


图 9-44 ”上 位 机 与 下 位 机 的 通信 协议 
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图 9-44 中 ， 各 字符 含义 为 : 

1) 0XFF 0XFF: 帧 头 。 

2) ID: 能 机 的 ID 编号 。 

3) HL: 给 定位 置 的 高 位 和 低位 。 

4) 最 后 一 字 节 : 命令 识别 位 。 

4. 人 机 交互 界面 设计 

在 用 户 使 用 移动 控制 终 问 时 ， 对 “外 骨髓 ”机 如 人 的 控制 由 人 机 交互 界面 完成 。 设 计 人 机 交 
互 界面 时 ， 从 Android 设备 多 媒体 播放 器 获得 灵感 ， 设 计 出 名 为 “HNG Client” 移 动 端 程序 。 将 
每 一 个 锻 烁 动作 想象 成 一 首 “ 歌 ”， 用 刀 对 于 机 器 人 的 所 有 的 操作 如 同 在 手机 上 选择 歌曲 一 样 。 

UI 界面 包括 运动 播放 界面 、 运 动 列 表 界 面 、 时 间 设 定 界 面 和 强度 设 定 界 面 四 个 组 成 部 分 。 
运动 播放 界面 概念 图 如 图 9-45 所 示 。 























运动 图 标 


运动 列表 鬼 钮 


蛇 积 运 动 次 数 


进度 提示 界面 





上 一 个 运动 播放。 下 一 个 运动 
图 9-45 ”运动 播放 界面 概念 图 

运动 播放 界面 各 单元 说 明 : 

1) 运动 图 标 : 清晰 提示 当前 运动 项 目 。 

2) 运动 列表 投 钮 : 打开 运动 项 目 选 择 列 表 。 

3) 设 定 按钮 : 设 定 硕 望 运 动 的 时 间 / 次 数 及 强度 。 

4) 关于 按钮 ， 得 到 关于 该 运动 的 信息 。 

5) 上 一 个 运动 : 播放 上 一 个 运动 列表 中 的 运动 。 

6) 播放 : 开始 当前 锻 烁 项 目 。 

7) 下 一 个 运动 : 播放 下 一 个 运动 列表 中 的 运动 。 

8) 进度 提示 界面 : 包含 当前 时 间 、 总 时 间 、 时 间 进 度 等 提示 。 

运动 播放 界面 设计 采用 网 格 型 列表 排 布 ， 奉 下 面 仍 有 未 显示 图 标 ， 在 触 屏 用 手 癌 上 拖 动 
整个 页 面 即 可 。 项 目 图 标 将 采用 大 图 标 ， 方 便 用 户 识别 和 选择 。 图 标 设 计 洒 用 肝 图 白 确 配色 ， 
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配 以 简 清 的 “人 偶 运 动 ” 图 标 ， 传 达 的 信息 直观 明了 。 

时 间 设 定 、 强 度 设 定 概念 图 如 图 9-46 所 示 。 设 定 包括 时 间 设 定 和 强度 设 定 ， 其 中 时 间 设 
定 分 为 时 间 模 式 和 次 数 模 式 。 拖 动 进度 条 可 调 布 运行 时 间或 锻炼 次 数 ， 强 度 设 定 同 上 ， 拖 动 
进度 条 即 可 改变 。 











时 间 设 定 
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图 9-46 ”时 间 设 定 、 强 度 设 定 概念 图 
9.3.4 ”安全 保护 装置 


针对 安全 性 考 夸 一 丰 中 讨论 出 的 可 能 发 生 的 危险 情况 ， 设 计 出 相应 的 应 对 策略 ， 提 高 机 器 
人 安全 性 能 。(W 关 贡 死 区 : 尽管 目前 电路 控制 技术 已 日 趋 完善 ， 可 以 从 控制 层面 完成 对 机 械 关 
节 “ 转 动 死 区 ”的 控制 。 但 是 由 于 目 喘 信号 传导 的 缺陷 与 程序 设计 的 不 完善 ， 这 种 死 区 控制 方 
法 依然 不 能 完全 你 证 其 可 徘 性 。 因 此 必须 从 机 械 层面 ， 设 置 限 位 机 构 ， 使 得 各 机 械 转动 副 的 运 
动 受 到 可 调整 的 限制 。@ 罕 戴 右 械 跌 倒 ， 通过 常识 可 以 得 知 ， 在 人 体 上 自由 运动 的 状态 下 ， 一 旦 
出 现 站 、 坐 姿 失去 平衡 的 情况 ， 可 以 通过 运动 胶体 、 调 整 文 撑 重新 获得 平衡 。 在 实际 使 用 该 作 
品 的 过 程 中 ， 使 用 者 的 脚 部 是 被 拥 绑 儿 扣 牢 牢固 定 在 机 需 踏 板 上 的 。 尽 管 目前 已 有 一 些 国家 的 
动力 需要 公司 〈 如 美国 的 Boston Dynamics) 已 研制 出 可 以 目 动 保持 并 恢复 平衡 的 两 足 行 走 人 形 
机 器 人 ， 但 是 这 一 技术 在 本 作品 进行 设计 的 当前 阶段 远 远 不 能 被 掌握 。 因 此 无 法 和 于 对 机 械 胶 体 
的 动作 控制 来 完成 对 驱 体 平衡 的 重新 获得 。 必 须 通 过 机 械 保护 装置 的 手段 ， 尽 量 避 人 免 人 体 在 使 
用 过 程 中 背负 看 右 械 队 地 的 情况 发 生 。(B3) 控 制 系 统 故 障 与 紧急 停机 : 对 系统 紧急 停机 按钮 的 设 
定 当 然 是 必 不 可 少 的 。 但 是 由 于 用 户 在 使 用 过 程 中 ， 双 手 往往 紧 握 手柄 ， 同 时 脚 部 的 活动 也 受 
到 捆绑 市 的 限制 。 所 以 单纯 徘 设 置 紧 急 停机 按钮 或 踏板 来 实现 停机 功能 是 远 远 不 够 的 ， 必 须 找 
到 其 他 使 用 指令 的 传播 途径， 不 依 徘 手脚 触 倍 按钮 来 实现 机 絮 人 的 紧急 停机 。 

1. 四 上肢 各 驱动 单元 保护 装置 

在 一 号 、 二 号 圆柱 直 齿 轮 传动 副 上 ， 分 别 在 齿轮 与 饭 金 框 并 上 议 置 会 上 友 生 机 械 干 涉 的 描 
片 ， 用 来 在 输出 轴 的 活动 范围 内 制造 运动 “ 死 区 ”， 与 人 体 各 关 市 的 “ 死 区 ”相对 应 。 在 一 
号 、 三 号 圆锥 下 齿轮 传动 副 上 ， 在 大 齿 数 锥 齿轮 上 设置 了 一 挡 片 ， 来 阻止 此 处 大 小 锥 齿轮 的 
| 咒 合 。 这 个 挡 厂 同样 像 圆 柱 齿 轮 输出 轴 一 样 ， 可 以 在 轴 的 转动 中 制造 “ 死 区 ”。 直 齿轮 挡 片 
和 锥 齿轮 接 厂 稚 图 分 别 如 图 9-47 和 图 9-48 所 示 。 
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图 9-47 直 齿 轮 挡 片 截图 图 9-48 ” 锥 齿轮 挡 片 截图 


2. 丢 干 后 倾 与 侧 摆 保护 装置 

为 防止 上 部 续 干 出 现 癌 后 倾倒 的 情况 ， 通 过 在 8R 连 杆 机 构 相 应 的 转动 副 上 添加 止 动 螺 
5] ， 在 此 转动 副 上 制造 出 “ 死 区 ”， 通 过 机 械 干 涉 防 止 出 现 上 慑 干 后 倾 的 现象 。 腰 部 止 动 蝶 
钉 如 网 9-49 所 示 。 











图 9-49 ”腰部 止 动 螺钉 
对 于 腰部 侧 倾 的 保护 ， 通 过 改变 8R 连 杆 下 部 的 外 形 设 计 ， 根 据 其 下 部 运动 规律 ， 在 其 运 





动 到 侧 倾 极限 位 置 时 ， 依 徘 两 根 杆 件 间 的 互相 干涉 来 阻止 这 一 运动 副 的 继续 运动 。 图 9-50 所 
示 为 腰部 侧 把 极限 位 置 。 





CTON 


Se 大 
这 二 
9-50 ”腰部 侧 摆 极 限 位 置 
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Eb 主要 创新 点 及 取得 的 成 果 


9.4.1 “作品 主要 创新 点 


1， 功 能 方面 的 创新 点 

(1) 概念 创新 “本 作 品 采用 人 体 包 覆 式 “外 骨骼 ”架构 进行 设计 ， 通 过 结构 支撑 与 动作 
驱动 两 大 功能 的 有 机 结合 ， 具 备 了 新 体验 健身 与 新 途径 康复 两 大 作用 。 与 现 有 普通 健身 与 康 
复 装置 不 同 ， 本 作品 从 人 机 工学 原理 出 发 ， 依 靠 精巧 空间 仿生 结构 与 人 体 产生 互动 ， 运 动 轨 
迹 与 人 体 实际 运动 轨迹 高 度 拟 合 ， 且 有 阻力 和 动力 两 种 输出 方式 ， 可 施加 人 体 健身 或 康复 运 
动 时 所 需 的 不 同 阻力 或 动力 ， 提 供 了 多 方式 健身 与 多 途径 康复 的 实用 功能 。 本 作品 的 研究 成 
果 对 未 来 “外 骨骼 系统 ”的 研发 具有 显著 的 借鉴 作用 和 参考 价值 

(2) 功能 创新 “与 普通 健身 与 康复 装置 不 同 ， 本 作品 具有 自由 动作 锻炼 功能 和 标准 姿势 
教学 功能 ， 智 能 化 、 自 主 化 程度 较 高 。 传 统 健身 需要 在 教练 的 指导 下 进行 ， 成 本 高 、 限 制 多 。 
本 作品 在 概念 创新 和 功能 创新 的 牵引 与 推动 下 ， 消 除了 这 些 限 制 ， 使 个 人 健身 可 在 科学 的 健 
身 理论 和 正确 的 健身 要 领 指导 下 进行 。 同 时 本 作品 的 技术 集成 度 和 功能 集成 度 远 高 于 其 他 健 
身 器 械 ， 几 乎 可 以 实现 全 种 类 健身 动作 的 锻炼 功能 。 

(3) 体验 创新 ”本 作品 自主 开发 在 WIFI 环境 下 基于 Windows 系统 的 PC 控制 设备 和 基于 
安 卓 系统 的 可 移动 控制 设备 ， 用 户 交互 体验 舒畅 便利 ， 所 配置 的 具有 安 卓 操 作 系统 的 客户 端 
功能 强大 ， 操 作 便捷 ， 通 用 性 好 ， 扩 展 性 强 ， 形 成 了 安 卓 客户 端 一 控制 系统 一 机 械 系 统 的 控 
制 结构 。 

2， 结 构 方面 的 创新 点 

(1) 仿生 研究 取得 新 突破 “在 开展 研究 期 间 ， 项 目 组 在 北京 体育 大 学 进行 了 多 次 “人 体 
动作 捕捉 实验 ”， 并 以 仿生 实验 的 数据 为 基础 ， 进 行 数学 模型 的 构建 与 作品 框架 的 设计 ， 在 
此 基础 上 再 进行 整体 结构 设计 。 由 于 仿生 研究 取得 新 突破 ， 使 得 仿生 空间 机 构 的 运动 轨迹 与 
人 体 实际 运动 轨迹 高 度 拟 合 ， 可 保证 作品 在 使 用 过 程 中 不 与 人 体 发 生 碰 撞 或 干涉 ， 符 合 人 机 
工程 学 原理 与 准则 。 

(2) 机 构 设计 取得 新 进展 ” 腰 背 运动 结构 的 设计 一 直 是 人 体 随 动机 构 设计 的 一 大 难题 。 
本 作品 所 设计 的 背部 8R 空间 连 杆 机 构 在 结构 方面 实现 了 较 大 的 创新 ， 可 保障 作品 实现 前 后 、 
左右 双 自由 度 的 运动 ， 因 而 可 实现 对 腰 背 部 绝 大 多 数 肌 肉 群 的 锻炼 : 包括 腹 直 肌 、 腹 横 肌 及 
腹 外 斜 肌 。 同 时 该 机 构 只 需 4 个 驱动 装置 便 可 完成 所 有 动作 ， 节 省 了 空间 ， 减 轻 了 重量 ， 强 
化 了 功能 ， 降 低 了 成 本 。 

(3) 驱动 输出 取得 新 效果 “本 作品 采用 多 人 台 直 流 电动 机 作为 提供 健身 与 康复 所 需 阻 力 和 
动力 的 施 力 器 件 ， 可 以 实现 不 同方 向 和 大 小 的 力 或 力矩 的 高 效 输出 。 对 于 按 多 种 趋势 变化 的 
负荷 ， 本 作品 也 能 够 通过 调整 电动 机 负荷 曲线 ， 改 变 电 动机 的 驱动 特性 ， 使 健身 或 康复 的 效 
果 最 大 化 。 

(4) 模块 设计 取得 新 成 果 “本 作品 通过 将 手 部 和 腿 部 具有 相似 特征 的 部 分 设计 为 通用 模 
块 结构 ， 使 机 身 的 制造 和 维护 更 加 方便 与 快捷 。 模 块 化 设计 的 实施 与 突破 ， 一 方面 可 使 作品 
制造 所 需 的 专用 器 具 减 少 ， 成 本 降低 ， 另 一 方面 可 使 作品 调整 所 需 的 时 间 与 步骤 大 为 缩短 和 
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简化 ， 比 如 模块 的 更 换 只 需 拆 季 两 颗 时 丝 即 可 完成 ， 操 作 简 便 。 

除了 上 述 突破 与 进展 以 外 ， 本 作品 在 下 述 方面 也 取得 了 相当 的 创新 成 末 : 

(1) 多 种 调整 结构 ”作为 一 球 针 对 不 同 使 用 群体 的 家 用 机 电 产 品 ， 本 作品 的 四 股 肥 腰痛 
均 具 有 范围 合理 的 矿 寸 调整 机 构 。 四 胶 的 调整 上 只 需 旋 松 锁 扣 ， 便 可 目 由 调整 长 度 ， 腰 育 的 调 
整 由 电动 机 控制 ， 操 作 界 面 集 成 在 客户 痕 中 。 同 时 ， 本 作品 还 配置 有 罕 戴 方便 的 背带 与 手柄 ， 
提高 了 人 体 与 机 融 接 触 的 舒适 度 。 

(2) 多 项 安全 措施 ”本 作品 共有 “大 市 限 位 挡 片 ”、“ 超 负债 急 仿 ”与 “ 防 倾倒 安全 座 
椅 ” 等 多 项 安全 你 护 功能 。 机 械 的 安全 性 设计 集成 在 各 个 恒 其 中， 结构 傈 单 ， 性 能 可 靠 ， 在 
降低 成 本 的 同时 保证 了 机 构 具 有 较 小 的 体积 。 同 时 ， 本 作品 还 设置 有 电气 安全 保护 措施 ， 上 
位 机 监测 到 电动 机 工作 状况 出 现 异 利 时 会 中 止 张 动 系统 供电 ， 同 时 保护 使 用 者 与 装置 本 吴 不 
受伤 害 。 

(3) 多 重 电 动机 控制 ”本 作品 其 有 22 个 目 由 度 ， 引 入 五 次 样 条 曲线 插 补 复 法 进行 运动 轨 
迹 规划 ， 采 用 四 阶 团 环 控 制 菏 略 ， 实 现 了 多 电动 机 协调 控制 ， 可 靠 度 高 ， 肥 应 灵敏 ， 你 障 本 
作品 能 够 完成 复杂 的 健身 与 康复 动作 。 


9.4.2 ”作品 取得 的 成 果 


本 作品 取得 的 成 果 如 下 : 

1) 已 制作 成 功 全 功能 、 整 系统 的 小 比例 (1:2) 原理 样机 ,样机 包含 技术 成 熟 、 功 能 齐全 、 
性 能 稳定 、 运 行 顺畅 的 机 械 结构 与 控制 电路 。 

2) “外 上 骨骼 ”智能 健身 与 康复 机 器 人 研究 技术 报告 1 份 。 

3) 申请 国家 发 明 专 利 2 项 : 

QD 外 骨骼 穿戴 式 健 有 号 与 康复 机 。 

@) 罕 戴 式 腰 背部 健 吴 与 康复 机 。 

《一 种 可 以 拟 合 人 类 兰 柱 前 倾 与 侧 摆 运 动 的 空间 连 杆 机 构 》。 

@《 拟 合 人 类 兰 柱 前 倾 与 侧 摆 运 动 的 空间 连 杆 机 构 的 运动 学 分 析 》。 

(3)《 一 种 可 以 拟 合 人 类 演 柱 前 倾 与 侧 摆 运动 的 空间 连 杆 机 构 的 技术 实现 》。 

5) 获奖 : 

Q 首都 高 校 第 六 届 机 械 创 新 设计 大 赛 北京 市 一 等 奖 。 

@) 第 五 届 全 国 大 学 生机 械 创 新 设计 大 赛 二 等 奖 。 

(3) 2012 年 北京 理工 大 学 “ 校 十 佳 优秀 创新 项 目 ”。 


忆 结 与 展望 


9.5.1 “作品 研发 工作 思 结 


本 项 目 针 对 现 有 市 场 健 映 与 康复 如 材 领域 产品 空缺 ， 上 用 准 当今 科 拷 友 展 前 沿 ， 人 研究 了 相 
天 学 科 的 基础 理论 与 技术 应 用 ， 开 展 了 本 作品 的 研发 工作 。 
1) 作品 采用 “人 体外 骨 能 ” 包 巷 方 式 进 行 设计 ， 各 机 械 运 动 副 完全 对 应 人 体 各 个 关 市 进 
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行 布置 与 设计 。 整 个 装置 在 使 用 者 进行 上 肢体 运动 时 ， 可 以 完美 贴 附 人 体 对 其 动作 进行 跟随 ， 
是 一 歌 名 副 其 实 的 人 体 随 动 装置 。 该 特性 从 根本 上 解决 了 目前 人 们 利用 健 映 /康复 器 械 进 行 运 
动 时 ， 因 器 械 种 类 庞杂 、 占 地 面积 过 大 而 受到 的 使 用 限制 。 

2) 作品 采用 蜗 性 能 、 大 力 答 直流 伺服 电动 机 作为 驱动 元 件 ， 可 同时 提供 健 喘 所 需 的 运动 
阻力 和 康复 所 需 的 牵引 动力 。 由 于 该 作品 的 控制 系统 采用 速度 环 、 力 算 环 、 位 置 环 的 反馈 式 
控制 ， 使 得 该 作品 可 以 实现 在 健身 /康复 过 程 中 对 各 构件 运动 位 置 的 精确 掌控 ， 且 能 同时 实现 
对 运动 速度 、 张 动 扭矩 “〈 力 度 ) 的 任意 调整 。 

3 ) 该 作品 在 腰 背 部 设置 的 “8R” 衬 间 炳 合 连 杆 机 构 可 以 完整 拟 合 人 体 将 柱 前 倾 与 侧 这 的 
运动 轨迹 。 访 机构 具 有 较 好 的 运动 拟 合 度 和 结构 创新 性 ， 可 以 在 未 来 对 “全 喘 式 外 骨 骨 ” 闭 
置 的 设计 起 到 借鉴 和 帮助 作用 。 

4) 为 保证 该 作品 拥有 广泛 的 受众 范围 (身高 160 一 190cm)， 该 作品 可 以 根据 不 同 需求 灵 
活 变换 手臂 、 下 及 与 驱 干 部 位 的 长 度 。 同 时 ， 作 品 还 针对 生物 关节 “运动 死 区 ”问题 ， 在 各 
运动 副 设 置 了 限 位 保护 装置 ， 保 证 该 作品 在 使 用 过 程 中 的 安全 性 。 

5) 该 作品 具有 极 强 的 智能 与 操控 拓展 特性 。 作 品 内 置 的 健身 资料 库 可 以 对 使 用 者 进行 健 
员 姿 势 的 教学 和 纠正 ， 并 可 以 针对 使 用 者 身体 状况 量 身 制定 出 相应 的 健身 计划 。 同 时 ， 访 作 
品 偿 具备 强大 的 控制 拓展 接口 ， 其 控制 总 成 具备 WIFI (无线 局 域 网 络 ) 通信 性 能 ， 可 以 和 任 
意 同样 具备 WIFI 功能 的 电子 设备 进行 通信 。 同 时 产品 还 配备 了 基于 安 间 操作 系统 的 控制 终端 
软件 ， 可 安装 在 使 用 者 的 个 人 电子 设备 (如 手机 〉 中。 用 户 可 以 在 手机 中 建立 私人 的 健身 档 
案 ， 包 括 详细 运动 记录 与 卡路里 消耗 。 用 户 可 以 在 不 同 的 机 器 人 上 ， 使 用 同一 部 手机 实现 同 
样 质量 的 “私人 服务 ”。 这 种 终端 控制 模式 具有 极为 高 效 的 人 机 交互 性 能 与 极 好 的 使 用 感受 ， 
对 于 现代 “智能 ”机 械 是 一 种 创新 的 操纵 手段 。 


9.5.2 ”展望 与 规划 
作品 运动 和 展示 效果 还 有 很 大 的 提升 空间 ， 这 也 是 今后 的 工作 重心 和 技术 拔高 之 所 在 。 
1. 机 械 部 分 
作品 设计 之 初 规划 了 可 变换 姿势 的 座 椅 支架 ， 与 美观 的 作品 有 瞪 挂 展示 架 。 若 将 此 些 附件 
配 齐 ， 作 品 将 更 具 展 示 效 果 与 完善 感 。 同 时 ， 和 需要 进行 一 些 结构 件 优化 和 一 些 连 接 件 的 改 民 。 
2. 电路 与 控制 部 分 
(1) 人 硬件 方面 
1) 希望 能 在 关键 天 布 配备 较 高 性 能 、 工 作 稳定 的 紫 机 ， 以 满足 其 对 力 窍 的 基本 要 求 。 
2) 配合 机 械 部 分 的 座 椅 文 架 和 悬挂 展示 架 对 作品 进行 重新 布线 。 















































































































































(2) 软件 方面 
1) 实现 对 骨 机 位 置 ， 速 度 和 力 窍 三 参量 的 闭环 控制 ， 位 置 的 三 阶 以 上 闭环 控制 ， 以 达到 
于 好 的 运动 效果 。 





2) 对 上 位 机 与 下 位 机 通信 协议 的 优化 和 改进 ， 以 提高 可 徘 性 。 

3) 为 了 实现 对 作品 运动 轨迹 和 合理 规划 ， 将 对 本 作品 进行 运动 学 和 动力 学 仿真 建 模 。 
3. 人 机 交互 部 分 

1) 记录 数据 的 机 制 不 完善 ， 有 竺 改进 。 
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2) 缺乏 很 多 运动 数据 ， 例 如 各 运动 动作 关节 的 力矩 数据 ， 需 查阅 大 量 资料 或 进行 实际 运 
动 数据 采集 。 

3) 将 来 希望 能 够 将 UI 界面 进行 改进 ， 提 升 用 户 体验 ， 简 化 操作 ， 通 过 轻松 而 有 趣 的 手 
势 操 作 来 实现 客户 端 所 提供 的 功能 ， 而 不 是 枯燥 乏 味 的 点击 动作 ; 配合 PC 服务 占 进 行 遂 信 协 
议 的 优化 ， 以 增强 通信 的 安全 性 和 可 徘 性 。 

“外 骨髓 ”类 右 械 由 于 其 优越 的 人 体 “ 随 动 性 ”与 功能 拓展 性 ， 有 潜力 成 为 一 球 人 类 与 机 
械 完 闫 融合 的 机 需 人 式 产 品 。 无 论 是 用 于 航空 航天 领域 的 控制 、 执 行 任 务 ， 还 是 用 于 军备 领 
域 的 提升 单 士 兵 作 战 能 力 ， 还 有 民用 领域 的 日 第 护理 、 健 喘 、 搬 运 与 控制 工作 ，“ 外 骨骼” 
关 需 械 都 有 看 目前 已 有 机 械 无 法 奉 代 的 人 机 交互 性 能 与 怀 人 的 工作 能 力 。 随 看 现代 制造 业 的 
发 展 与 工业 水 平 的 提高 ， 性 能 优越 的 新 材料 与 高 性 能 的 电 霹 元 件 不 断 问世。 相信 在 不 久 的 将 
来 ， “外 肯 骼 ”的 制造 难度 、 设 计 成 熟 度 与 工作 性 能 都 将 得 到 极 大 的 改 画 ， 其 造价 也 将 大 幅 
及 降低 。 最 终 ，“ 外 骨 能 ”类 帮 械 将 会 像 汽车 一 样 ， 作 为 一 球 成 熟 且 功能 强大 的 综合 日 用 产 
品 ， 成 为 大 家 日 常生 活 中 不 可 或 缺 的 一 部 分 。 现 代 社 会 “机 器 人 ”技术 正在 得 到 迅猛 发 展 。 
而 “外 骨骼 ”恰恰 是 一 种 可 以 穿戴 在 人 体 号 上 机 占 人 。 随 看 机 械 智 能 化 与 生物 交互 拉 术 的 肥 
展 ， 我 们 有 理由 相信 ，“ 外 骨骼 ”类 机 械 将 会 成 为 一 球 终 极 人 机 交互 与 能 力 拓展 机 器 人 ， 而 
“外 骨髓 ”智能 健身 与 康复 机 右 人 作为 一 种 典型 的 “外 骨骼 ”关机 电 一 体 化 产品 ， 将 在 目 映 
不 断 完 善 改 进 提 高 的 过 程 中 ， 实 现实 用 化 ， 开 辟 出 健身 与 康复 领域 中 新 理论 与 新 技术 相 融 合 
的 新 途径 。 
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第 10 章 高 处 空间 物品 存放 及 管理 系统 
(首部 高 校 第 六 届 机 械 创新 设计 大 赛 二 等 奖 ，2012 年 ) 


兽人 作品 研究 的 背景 及 蕙 义 


1. 市 场 调研 
我 国 城乡 新 建 住宅 面积 和 居民 住房 数据 显示 ( 见 表 10-1)，2006 年 城市 人 均 住 宅 面积 为 
27.1m ， 农 村 为 30.7m*。 这 些 数据 表明 我 国人 均 住 宅 面 积 并 不 充裕 ， 而 与 这 种 现状 形成 鲜明 
对 比 的 是 人 们 对 家 居 空 间 的 利用 率 不 足 。 通 党 普通 住房 的 建筑 高 度 在 2.Sm 一 3m 之 间 , 但 是 由 
于 高 层 空 间 较 难 利用 ， 使 得 住房 空间 的 占 空 比 很 小 ， 造 成 了 室内 空间 资源 的 极 大 浪费 。 所 以 
如 何 充分 利用 室内 空间 ， 尤 其 是 高 层 空间 进行 储 物 成 为 当今 家 居 装 置 设计 的 难点 之 一 。 
表 10-1 城乡 新 建 住宅 面积 和 居民 住房 数据 


年 。 份 | 城镇 新 建 住宅 而 积 / 亿 m | 农村 新 建 住宅 面积 / 亿 mz | 城市 人 均 住 宅 面积 mm” | ”农村 人 均 住宅 面积 /nm 
| 





























1978 1.00 | 8.1 


主 ， 此 数据 来 源 于 中 国 统计 年 鉴 (2009)， 城 市 人 均 住宅 面积 由 住房 和 城乡 建设 部 提供 ，2008 年 数据 暂 缺 。 

目前 国内 的 家 居 储 物 装置 种 类 繁多 、 样 式 各 寞 ， 主 要 在 材料 使 用 、 储 物种 类 、 产 品 功 能 
各 有 特色 。 如 在 储 物 收纳 钱 置 中 使 用 的 材料 主要 有 : 塑料 、 蕨 条、 金属 、 竹 如、 无 纺 布 、 纸 板 、 
柳编 、 草 编 、 牛 津 布 等 各 类 材质 ， 储 物种 类 主要 包括 : 衣物 、 鞋 帽 、 书 籍 、 首 饰 、 陶 器 、 化 妆 
用 品 、 数 码 产 品 等 其 他 各 类 杂 物 ， 产 品 设计 上 主要 有 : 地 震 安 全 护 身 衣 柜 、 分 层 衣柜 、 具 有 抽 
层 结 构 的 布衣 柜 、 拼 接 式 旅行 衣柜 、 多 开门 衣柜 等 设计 各 异 的 收纳 衣柜 产品 及 专利 ， 产 品 功 能 
上 主要 有 : 杀菌 消毒 收纳 盒 、 遥 探 衣柜 床 、 有 通风 系统 的 净 衣 柜 及 一 些 具有 遥控 灯 等 装置 的 产 
品 ; 在 智能 化 方面 ， 主 要 有 一 些 温 控 、 光 感 类 产品 。 但 目前 国内 并 没有 人 针对 不 同 物品 类 别 及 相 
关 产 品 信 息 进行 分 类 的 装置 ， 也 缺乏 充分 利用 蜗 层 空间 、 吞 能 化 的 收纳 狼 置 。 科 学 技术 的 进步 
使 人 们 对 生活 品质 有 了 更 高 的 退 求 ， 智 能 化 家 居 装 置 将 成 为 未 来 的 发 展 趋势 。 

2. 技术 背景 

20 世纪 80 年 代 初 ， 智 能 家 居 的 概念 就 已 经 被 提出 。 智 能 家 居 是 一 种 居住 环境 ， 它 以 住宅 
为 平台 ， 利 用 综合 布线 技术 、 网 络 通信 技术 、 安 全 防范 技术 、 和 上 自动 控制 技术 、 音 视频 技术 将 
与 家 届 生 活 有 关 的 设施 集成 ， 构 建 高 效 的 住宅 设施 与 家 庭 日 程 事务 的 管理 系统 ， 提 升 家 居 安 
全 性 、 便 利 性 、 和 舒适 性 和 艺术 性 ， 并 实现 环保 节能 的 居住 环境 。 

智能 家 居 系 统 包含 的 子 系统 主要 有 : 家 居 布 线 系统 、 家 庭 网 络 系统 、 智 能 家 居 探 制 管理 
系统 、 家 居 照 明 控 制 系统 、 家 庭 安 防 系统 、 背 景 音 乐 系统 、 家 庭 影 院 与 智能 家 居 控 制 系统 、 
多 媒体 系统 、 家 庭 环境 控制 系统 等 八大 系统 。 其 中 ， 智 能 家 居 控 制 管理 系统 、 家 居 照 明 控制 
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系统 、 家 庭 安 防 系统 是 必 备 系统 ， 家 居 布 线 系 统 、 家 庭 网 络 系统 、 背 景 音 乐 系统 、 家 庭 影院 
与 多 尹 体 系统 和 家 大 环 境 控 制 系统 为 可 选 系统 。 

智能 家 居 实 现 的 功能 和 提供 的 服务 主要 有 以 下 儿 个 方面 : 

1) 始终 在 线 的 网 络 服务 : 与 互联 网 随时 相连 ， 为 在 家 办 公 提 供 了 方便 条 件 。 

2) 安全 防范 : 智能 安防 可 以 实时 监控 非法 问 入 、 火 灾 、 煤 气 泄露 、 紧 急 呼 救 等 状况 
的 发 生 。 

3) 家 电 的 智能 控制 和 远程 控制 : 如 对 灯光 照明 进行 场景 设置 和 远程 控制 、 电 需 的 目 动 控 
制 和 远程 控制 等 。 

4) 交互 式 智 能 控制 : 可 以 通过 语音 识别 技术 实现 智能 家 电 的 声控 功能 ， 通 过 各 种 主动 式 
传感器 〈 如 温度 、 声 音 、 动 作 等 ) 实现 智能 家 居 的 主动 性 动作 响应 。 

5) 环境 上 自动 控制 : 如 家 庭 中 央 空 调 系统 。 

6) 提供 全 方位 家 性 娱乐 : 如 家 性 影院 系统 和 家 性 中 央 背 景 首 乐 系统 。 

7) 现代 化 的 厨 卫 环境 ， 主要 指 整 体 厨 房 和 整体 卫浴 。 

8) 家 尾 信 息 服 务 : 管理 家 硅 信 息 及 与 小 区 物业 管理 公司 联系 。 

9) 家 庭 理 财 服 务 : 通过 网 络 完成 理财 和 消费 服务 。 

10) 目 动 维护 功能 : 智能 信息 家 电 可 以 通过 服务 器 直接 从 制造 商 的 服务 网 站 上 目 动 下 载 、 
更 新 驱动 程序 和 诊断 程序 ， 实 现 智 能 化 的 故障 自 诊 断 、 新 功能 目 动 扩展 。 

本 作品 旨 在 为 当今 处 在 快 节 故 生 活 的 人 们 提供 方便 的 物品 储存 与 信息 提示 ， 如 衣物 的 面 
料 材 质 及 洗涤 方法 、 食 物 的 食用 方法 及 保质 期 、 书 本 的 检索 与 分 类 信息 等 ， 这 些 信 息 的 建立 
与 传播 离 不 开 与 当今 物 联网 发 展 的 结合 。 

物 联 网 是 通过 射频 识别 、 红 外 感应 器 、 全 球 定位 系统 、 激 光 扫 摘 需 等 信息 传 感 设 备 ， 按 
约定 的 协议 ， 把 物品 与 互联 网 相连 接 ， 进 行 信息 交换 和 通信 ， 以 实现 智能 化 识别 、 定 位 、 跟 
踩 、 监 控 和 管理 的 一 种 网 络 。 通 过 与 无 线 通 信 技 术 云 计算 和 新 一 代 移动 通信 系统 相 结合 ， 物 
联网 将 以 更 快 的 速度 发 展 ， 并 进一步 拉 近 与 人 们 日 常生 活 的 距离 。 

1) 物 联 网 与 无 线 通信 结合 : 物 联网 环境 下 的 无 线 局 域 网 内 通信 主要 是 对 现 有 了 网络 中 和 点 
的 拓扑 结构 、 贡 点 个 数 等 信息 进行 管理 和 显示 。 

2) 物 联 网 与 云 计算 结合 : 物 联 网 的 智能 处 理 依靠 先进 的 信息 处 理 技术 ， 如 云 计 算 、 模 式 
识别 等 技术 。 云 计算 可 以 从 两 个 方面 促进 物 联 网 和 智 芒 地 球 的 实现 ， 首 先 ， 云 计算 是 实现 物 
联网 的 核心 ， 其 次 云 计 算 可 促进 物 联 网 和 互联 网 的 智能 融合 。 

3) 物 联网 与 TD 结合 : TD-SCDMA 是 我 国 拥有 目 主 知识 产权 的 第 三 代 移 动 通信 系统 ， 是 

类 先进 的 宽带 无 线 通信 网 络 。 积 极 推动 无 线 传 感 句 网 络 与 TD 网 络 融合 ,构建 适 于 物 联 网 应 
用 的 GPRS/TD/WSN 〈 无 线 传 感 右 网 络 ) 融合 网 络 ， 将 为 物 联 网 的 发 展 提 供 强 有 力 的 文 撑 。 

2010 年 5 月 发 布 的 物 联网 白皮书 中 预计 ,“ 十 二 五 ” 结束 时 ， 我 国 物 联 网 相关 产业 规模 将 
达到 五 千 多 亿 的 规模 ， 形 成 万 亿 级 规模 的 时 间 币 点 。 预 计 在 “十 三 五 ”后 期 ， 将 锁定 十 大 物 
联网 应 用 重点 领域 : 智能 电网 、 智 能 交通 、 智 能 物流 、 智 能 家 居 、 环 境 与 安全 检测 、 工 业 与 
自动 化 控制 、 医 疗 健康 、 精 细 农 牧 业 、 人 金融 与 服务 业 、 国 防备 事 ， 建 成 50 个 面向 物 联网 应 用 
的 示范 工程 、5$ 一 10 个 示范 城市 。 可 见 ， 物 联网 必 将 成 为 今后 国民 生产 的 主要 信息 平台 。 

3. 研究 意义 

调查 可 知 ， 中 国 普通 住房 室内 高 度 多 在 2.5~3m 之 间 ， 而 储 物 柜 体高 度 通 常 只 有 2m， 这 
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种 现状 使 屋内 高 处 空间 浪费 极 大 ， 由 此 带 来 的 居住 人 口 、 存 放 物 品 与 住房 空间 之 间 的 矛盾 也 
越 来 越 突 出 。 同 时 ， 随 看 生活 水 平 的 提高 ， 人 们 的 耐用 性 消费 物品 的 数量 逐年 增长 ， 如 衣物 、 
书本 、 杀 物 等 种 类 与 数量 越 来 越 多 ， 而 每 当 人 们 急需 一 件 被 长 期 收纳 的 物品 时 ， 由 于 储存 的 
物品 种 类 及 数量 壹 多 ， 使 得 寻找 该 物品 变 得 非常 抹 烦 。 同 时 ， 我 国 社 会 的 老龄 化 程度 不 断 加 
剧 ， 如 何方 便 老 弱 人 群 进行 杂 物 存 取 也 是 改善 家 居 生 活 条 件 一 个 吸 竺 解决 的 问题 。 

传统 的 高 空 储 物 方式 只 是 物品 的 简单 堆积 ， 不 仅 美 观 性 震 ， 物 品 取 放 危险 性 也 局 ， 且 不 
便于 得 找 ， 储 物 效 率 低 ， 难 以 满足 现代 人 们 退 求 高 品质 生活 的 需求 。 针 对 以 上 问题 及 传统 高 
空 储 物 方式 的 不 足 ， 项 目 组 以 改善 家 居 条 件 为 目标 ， 以 舒适 度 更 高 、 简 单方 便 为 设计 理念 ， 
研制 了 一 套 宇内 局 处 空间 物品 存放 及 管理 智能 化 疙 置 。 本 作品 不 仅 可 以 实现 物品 的 目 动 存 取 ， 
还 可 以 实现 物品 信息 分 类 、 精 准 定 位 、 目 动 检 索 、 人 机 交互 等 智能 化 的 管理 功能 ， 对 提高 室 
内 罕 间 利用 雍和 储 物 效 率 及 缓解 人 、 物 品 、 住 房 空 间 之 间 的 让 慎 具 有 重要 意义 。 


作品 概述 


10.2.1 研究 内 容 概述 


高 处 空间 物品 存放 及 管理 系统 是 一 种 集 机 械 结 构 、 电 路 控制 、 软 件 技术 于 一 体 的 智能 型 
机 电 一 体 化 装置 ， 其 主要 研究 内 容 包 括 : 系统 总 体 设计 、 机 械 结 构 设 计 、 控 制 电 路 设计 、 驱 
动 程序 设计 和 系统 软件 开发 。 

1. 系统 总 体 设计 

系统 总 体 设计 决定 着 高 处 空间 物品 存放 及 管理 系统 整个 研究 工作 的 成 败 及 研究 水 平 的 高 
低 ， 其 核心 是 功能 与 结构 的 合理 组 合 、 性 能 与 效果 的 协调 统一 ， 以 此 引导 噩 处 空间 物品 存放 及 
管理 系统 的 设计 思想 、 研 究 方 法 、 功 能 原理 、 结 构 特 点 、 设 计 技 巧 、 技 术 途 径 等 的 全 面 创新 。 

2. 机 械 结 构 设 计 

机 械 结 构 设 计 是 高 处 空间 物品 存放 及 管理 系统 研究 的 基础 。 该 系统 机 械 结构 部 分 主要 包括 县 
挂 货架 、 安 装 于 悬挂 货架 上 的 竖 直 升 降 装 置 、 水 平 拖 动 装 置 和 储 物 单元 取 放 装置 。 悬 挂 货 架构 成 
系统 的 基本 框 染 ， 埠 挂 货架 右 侧 为 两 层 隅 板结 构 ， 可 放置 2 排 3 列 共 6 个 储 物 单 元 ， 竖 下 升降 涛 
置 主要 由 步 进 电动 机 、 同 步 带 传动 机 构 、 传 动 轴 、 钢 丝 绳 和 托盘 等 组 成 ， 可 实现 储 物 单元 的 升降 
操作 ;， 储 物 和 单元 取 放 装置 由 两 台 步 进 电 动机 驱动 ， 通 过 同步 带 传动 机 构 分 别 实现 储 物 香 元 的 竖 下 
升降 运动 和 水 平 抽 拉 运 动 ， 实 现 将 储 物 单 元 放置 于 及 挂 货架 上 或 从 虹 挂 货 染 上 取出 水平 拖 动 浅 
置 主要 由 步 进 电动 机 、 滑 块 和 直线 导轨 等 组 成 ， 可 带动 储 物 单 元 沿 直线 导轨 作 水 平 运动 。 

3. 控制 电路 设计 

电路 设计 是 高 处 空间 物品 存放 及 管理 系统 控制 系统 部 分 研究 的 重要 内 容 ， 其 中 控制 模块 
和 电源 管理 模块 是 该 部 分 的 研究 重点 。 访 系统 的 控制 电路 选用 单 族 机 STC89C52 为 核心 必 搬 
构成 最 小 系统 ， 包 括 电 源 模块 、 品 振 电路 、 复 位 电路 、 串 口 电路 等 。 为 满足 不 同 模块 对 不 同 
电源 的 要 求 ， 电 源 模块 在 人 硬件 设计 上 ， 采 用 先进 的 压 差 调节 器 ， 在 节省 控制 电源 数量 的 同时 
保证 了 系统 的 功率 需求 和 稳定 性 。 

4. 驱动 程序 设计 

驱动 程序 部 分 的 设计 任务 是 通过 一 片 C52 单片机 ， 控 制 系统 运行 时 四 人 台 步 进 电 动机 的 驱 
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动 囊 ， 使 之 带动 功率 各 不 相同 的 四 台 步 进 电 动机 ， 完 成 上 位 机 通过 串 行 口 发 出 的 规定 动作 ， 
并 将 整体 位 置 误差 控制 在 5% 以内。 由 于 C52 本 喘 的 便 件 资源 有 限 ， 并 缺少 外 部 中 断 源 ， 因 此 
如 何 对 有 限 的 系统 便 件 资源 进行 元 分 的 利用 是 该 部 分 的 设计 重点。 

$5. 系统 软件 开发 

为 方便 用 户 取 放 和 管理 物品 ， 需 要 研究 民 好 的 用 户 操作 界面 。 通 过 系统 软件 开 及 ， 一 方面 拥 
供 友 好 、 易 于 操作 的 用 户 界 面 及 详细 的 用 户 使 用 说 明 ， 方 便 普 通用 户 快速 学 握 软 件 的 使 用 方法 ， 
劝 一 方面 提供 设计 合理 、 使 用 方便 的 软件 功能 ， 方 便 用 户 省 时 省 力 地 完成 对 家 居 物 品 的 管理 。 


10.2.2 技术 指标 


作品 的 具体 技术 指标 如 下 : 

1) 储 物 柜 尺寸 长 乏 2000mm， 宽 科 600mm， 高 乏 1000mm， 重 科 20kg; 运载 小 车 尺寸 
长 三 500mm, 宽 三 500mm, 高 乏 1000mm, 重 科 1$kg; 操作 台 尺 寸 长 筷 1600mm, 宽 三 600mm， 
高 迄 800mm， 重 科 30kg。 

2) 储 物 柜 层 间距 为 200mm， 储 物 盒 最 大 设计 载 何 为 15kg。 

3) 可 实现 储 物 盒 在 储 物 柜 中 任意 位 置 的 存放 与 取 用 。 

4) 具有 友好 、 吻 于 操作 的 用 户 界 面 及 详细 的 用 户 使 用 说 明 ， 以 方便 普通 用 户 快 速 掌 握 软 
件 的 使 用 方法 。 

5) 提供 设计 合理 、 使 用 方便 的 软件 功能 ， 方 便 用 户 省 时 省 力 地 完成 对 家 居 物 品 的 管理 。 


天 键 近 术 



























































10.3.1 系统 设计 方案 

1. 系统 总 体 设计 方案 

本 系统 设计 的 目的 在 于 提供 一 种 能 够 提高 室内 空间 
利用 率 和 储 物 效率 的 高 处 空间 物品 存放 及 管理 系统 ， 图 
10-1 为 系统 总 体 布 置 图 。 

整个 系统 由 芒 挂 货架 安装 于 蕊 挂 货架 上 的 竖 直 升降 
北 置 、 水 平 拖 动 北 置 、 储 物 单 元 取 放 浅 置 、 寿 干 储 物 单元 
及 软件 管理 平台 组 成 。 悬 持 货 架 可 用 螺栓 固定 在 室内 高 
处 , 构成 系统 的 基本 框架 , 悬挂 货架 右 侧 的 两 层 隔 板 可 放 
署 2 排 3 列 共 6 个 储 物 单元 , 在 储 物 单 元 内 存放 该 系统 自 
动 分 类 的 各 种 物品 。 本 系统 依托 机 构 与 电路 设计 、 软 件 技 
术 实 现 物品 的 目 动 分 类 及 存 取 功 能 ， 是 一 种 集 信 息 的 采 
集 、 整 合 、 文 配 于 一 体 的 智能 型 机 电 一体 化 产品 。 


2. 各 装置 设计 方案 









































(1) 竖 直 升降 装置 ”图 10-2 为 竖 直 升降 装置 工作 平 图 10-1 系统 忠 体 布 站 图 
se 0 . 加 ER 1 一 悬挂 货架 “2 一 扫 码 枪 ”3 一 条 形 码 打 印 机 
台 示 蔓 图 。 竖 直 升 降 装置 包括 平板 、 电 动机 工 、 同 步 珊 轮 4 一 触摸 屏 5 一 储 物 单元 
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I 、 同 步 市 轮 开 、 同 步 珊 工 、 传 动 籼 、 疮 线 简 工 、 固 定 轴承 、 疮 轮 、 定 滑轮 工 、 锁 死机 构 、 饥 
丝 绳 工 、 托 盘 、 清 块 工 和 直线 导轨 工 。 电 动机 工 固定 在 巧 挂 货 巢 左 上 方 的 平 析 上， 同步 市 轮 I 
安 狠 在 电动 机 工 的 转轴 上 ， 通 过 路 合同 步 带 工 使 同步 市 轮 开 转动 ， 进 而 使 安装 在 冉 定 轴承 上 的 
传动 轴 转 动 ， 达 到 降低 转速 的 目的 。 钢 丝 绳 工 的 一 站 回 定 在 传动 轴 的 疮 线 简 工 上 ， 夯 一 丧 问 定 
在 用 于 容纳 储 物 单元 的 托盘 上 ， 依 徘 定 滑 轮 工 的 导 问 作用 ， 将 水 平 运动 转换 成 竖 直 运动 从 而 带 
动 托 盘 升 降 。 托 盘 背 部 安 站 有 两 个 消 块 1， 可 沿 固 定 在 若 挂 负 染 后 方 的 两 根 直 线 导 轨 工 滑动 ， 
以 此 保证 托盘 坚 二 运动 的 平稳 性 。 平 板 上 还 安装 有 锁 死 机 构 ， 在 系统 晰 电 时 将 卡 住 传动 轴 上 的 
齿轮 ， 防 止 托 盘 在 储 物 单 元 及 目 身 重力 作用 下 突然 下 请 ， 伤 害 用 户 。 

(2) 水 平 拖 动 装 症 ”图 10-3 为 水 平 拖 动 朔 置 示 意图 。 水 平 拖 动 猴 置 包括 平板 、 电 动机 开 、 
卷 线 简 开 、 定 滑轮 工 、 钢 丝 绳 工 、 滑 块 工 和 直线 导轨 工 。 晤 排 货架 上 层 框架 内 侧 分 布 安装 大 
干 定 滑轮 代 ， 前 方 框 染 上 下 各 固定 一 条 和 直线 导轨 全， 电动 机 工 辣 定 在 平板 上 ， 其 转轴 上 和 安 疙 
有 耸 线 简 工 ， 巷 线 和 傈 开 分 为 两 部 分 ， 分 别 用 于 收 、 放 钢丝 绳 工 ， 钢 丝 强 开 依 徘 定 清 轮 开 的 寻 
器 作用 ， 缠 绕 在 苍 挂 贷 架 前 上 方 的 空间 内 ， 可 带动 储 物 单 元 取 放 汇 置 连接 板 工 和 连接 板 匡 上 
的 请 块 工 治 直 线 导 轨 开 作 水 平 运 动 。 


















































图 10-2 ” 竖 直 升降 装置 工作 平台 示意 图 图 10-3 ”水 平抑 动 装置 示意 
1 一 固定 轴承 ”2 一 卷 线 简 1 ”3 一 定 滑轮 I 4 一 平板 1 一 电动 机 工 ”2 一 定 滑轮 荆 3 一 钢丝 强 I 4 一 托盘 
5 一 传动 轴 6 一 锁 死 机 构 7 一 齿轮 8 一 电动 机 I 5 一 滑 块 1 ”6 一 直线 导轨 1 ”7 一 直线 导轨 I 

9 一 同步 带 轮 全 ”10 一 同步 种 轮 1 11 一 同步 带 I 8 一 钢丝 绳 I 9 一 卷 线 简 II 


(3) 储 物 单 元 取 放 疙 是 ”图 10-4 为 储 物 单元 取 放 涛 年 示意 图 。 储 物 单元 取 放 北 置 包 
括 电 动机 I 五、 同步 市 轮 I、 同 步 市 轮 信 、 同 步 市 匡 、 电 动机 人 V、 同 步 市 轮 V、 同 步 市 1、 
托 板 、 丝 枉 、 光 杠 I 、 光 杠 工 、 滑 块 卫 、 连 接 板 1、 连接 极 工 、 连 接 板 王 和 连接 板 V。 连 
接 板 工 与 连接 板 工 用 四 根 光 杠 工 连接 ， 连 接 板 开 和 连接 板 卫 用 三 根 罕 过 托 板 的 区 杠 工 连 
接 ， 保 证 该 闻 置 整体 强度 。 连 接 板 工 上 安 猴 清 块 工 两 个 ， 连 接 板 贡 上 安 猴 滑 块 工 一 个 。 丝 
杠 穿 过 托 板 ,一端 固 连 在 连接 板 H 五 上 的 轴承 内 ， 为 一 痢 通 过 同步 市 轮 I 开 、 同 步 带 轮 人 V、 同 
步 带 工 构成 的 同步 带 机 构 与 安装 在 连接 板 荆 上 的 电动 机 斑 连 接 ， 电 动机 王 转 动 使 丝 杠 旋 
转 ， 托 板 上 安 猴 痢 的 与 光 杠 工藤 套 的 三 个 直线 轴承 可 使 托 板 在 旋转 丝 杠 的 带动 下 做 紧 直 升 
降 运 动 。 托 板 下 方 一 侧 安 疙 有 同步 市 亚 ， 与 安 沪 在 电动 机 转轴 上 的 同步 市 纶 V 路 合 ， 电 
动机 人 V 固 定 在 托 板 下 方 ， 托 板 在 电动 机 人 的 市 动 下 做 水 平 抽 拉 运动 。 状 年 两 侧 还 设 有 连接 
板 IV， 用 于 增加 浅 置 强度 。 
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a) b) 
图 10-4” 储 物 单 元 取 放 装置 示意 
a) 储 物 单元 取 放 装置 示意 图 b) 储 物 单元 取 放 装置 主 视图 
1 一 同步 带 轮 I 2 一 光 杜 1 ”3 一 电动 机 I 4 一 光 杠 工 。”5$ 一 丝 杠 6 一 托 板 7 一 同步 带 轮 人 V ”8 一 同步 带 了 I 
9 一 连接 板 I ”10 一 滑 块 ”11 一 连接 板 芽 ”12 一 连接 板 开 13 一 电动 机 IV ”14 一 同步 带 轮 V 15 一 同步 带 [ ”16 一 连接 板 IV 


(4) 软件 管理 平 侣 ”网 10-5 为 软件 管理 平台 的 使 件 组 成 。 软 件 管理 平台 使 件 设施 包括 触 
摸 屏 、 扫 码 枪 和 条 形 码 打印 机 。 

该 便 件 设施 安 猴 在 巧 挂 货架 下 方 用 户 方便 使 用 处 。 用 户 可 通过 触摸 屏 登 录 该 管理 平 合 ， 
当 存 放 物 品 时 ， 用 扫 码 枪 对 物品 扫 码 ， 系 统 会 目 动 取 下 合适 的 储 物 单元 ， 符 用 户 放 入 物品 后 
系统 将 其 目 动 放 回 。 知 物品 无 条 形 码 ， 则 用 户 可 目 行 了 录入， 将 打印 机 打印 出 的 条 形 码 贴 在 物 
品 上 。 当 取 用 物品 时 ， 用 户 可 通过 触摸屏 搜索 该 物品 ， 系 统 会 目 动 取 下 物品 所 在 的 储 物 单 元 ， 
用 户 取 出 物品 后 系统 将 储 物 单 元 目 动 收回 。 用 户 平 种 可 通过 该 平台 了 解 物品 的 存放 日 期 、 存 
放 位 置 、 保 质 期 等 详细 信息 ， 实 现 对 存储 物品 的 综合 化 、 智 能 化 管理 。 

1 3 
































图 10-5 ”软件 管理 平台 的 硬件 组 成 
1 一 扫 码 枪 ”2 一 条 形 码 打 印 机 ”3 一 触摸 屏 


10.3.2 机械 结构 设计 


1. 储 物 单元 取 放 浅 置 设计 
(1) 设计 思路 ”将 存放 于 所 设计 储 物 柜 中 的 储 物 盒 进 行规 定位 置 变换 ， 因 所 设计 的 储 物 
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柜 为 双 层 结构 ， 故 所 需 运 动 可 简化 为 层 间 提升 运动 和 将 储 物 盒 取出 所 在 隅 层 的 抽 拉 运动 ， 之 
后 配合 链 式 水 平 运动 辅助 ， 即 可 实现 在 储 物 柜 中 任意 位 置 储 物 盒 的 存放 与 取 用 。 

(2) 设计 方案 储 物 柜 分 为 两 层 , 层 间距 为 200mm,，, 储 物 盒 尺寸 为 长 340mm、 宽 240mm、 
高 140mm， 壁 厚 为 2mm， 最 大 设计 载荷 为 13kg。 升 降 结 构 的 主要 功能 是 对 储 物 盒 的 升降 平台 
进行 提升 ， 便 于 物品 存 取 ， 最 大 提升 距离 约 为 300mm。 

1) 整体 结 构 设 计 。 整 体 采用 框架 结构 ， 以 3 根 光 杠 作为 支撑 连接 各 个 平台 的 主要 结构 ， 
各 层 平台 采用 4mm 厚 铝板 进行 加 国 ， 并 对 各 功能 区 进行 分 层 设计 。 图 10-6 是 输送 平台 整体 
结构 示意图 。 


























图 10-6 ”输送 平台 整体 结构 示意 图 

a) 输送 平台 背 立 面 图 b) 输送 平台 正 立 面 图 
2) 输送 结构 设计 。 输 送 结构 主体 分 为 2 个 区 域 ， 下 侧 区 域 为 储 物 盒 升降 移动 空间 ， 该 空 
间 主 要 对 储 物 升降 平台 的 移动 位 移 进行 限制 。 上 侧 部 分 为 丝 杠 驱动 部 分 ， 步 进 电 动机 通过 同 
步 种 轮 将 动力 传递 给 丝 杠 。 步 进 电动 机 通过 4 锋 赂 和 钉 固 定 在 平台 上 ， 保 证 其 定位 。 步 进 电动 














机 与 同步 市 轮 之 间 通 过 顶 丝 进行 轴 则 国定， 并 提供 一 定 的 周 同位 移 限 制 。 丝 杠 与 同步 币 辊 之 
间 通 过 项 丝 相 连接 ， 接 触 面 加 工 一 平面 ， 使 得 顶 丝 与 丝 杠 之 间 的 周 向 固定 更 加 牢固 。 丝 杠 的 
轴 问 固定 通过 丝 杠 两 端的 螺纹 来 实现 。 

滚珠 丝 杠 的 选择 : 丝 杠 主要 承受 轴 同 力 ， 提 升平 台所 受 章 力 均 为 丝 杠 所 承受 ， 男 外 还 需 
要 承受 少量 径 癌 力 。 为 节约 成 本 ， 并 考虑 市 场 的 供 货 情况 ， 最 终 选用 直径 为 12mm 的 深 珠 丝 
杠 ， 丝 杠 长 度 为 S00mm， 额 定 承受 载荷 为 20kg。 

3) 储 物 盒 取 放 平台 设计 。 图 10-7 为 储 物 盒 取 放 平 台 。 取 放 平 台 托 板 采 用 4mm 厚 铝 板 ， 
重量 轻 ， 便 于 加 工 ， 并 且 易 于 拆卸 。 平 台 托 板 上 方 固 定 有 导 癌 滑 轨 支撑 架 ， 可 以 双 回 滑动 带 
动 托 板 与 其 上 的 储 物 盒 进行 平移 运动 ， 使 得 储 物 盒 进 入 储 物 柜 所 在 文 架 外 侧 移动 空间 ， 进 行 
储 物 盒 所 在 空间 位 置 的 变化 运动 。 

储 物 盒 存 取 延 伸 臂 ， 由 两 条 工 型 铝 材 铣 前 成 型 ， 如 图 10-8 所 示 。 延 伸 臂 通过 两 条 双 回 滚 
动 滑 轨 进 行 定位 ， 并 且 大 大 减 小 延伸 臂 与 托 板 之 间 所 产生 的 摩 控 力 ， 提 高 整套 系统 的 效率 。 
两 套 延 伸 辟 之 间 通 过 铝 材 进行 连接 ， 你 证 两 侧 延 伸 恬 之 间 的 同步 。 为 加 强 两 延伸 辟 的 强度 ， 
分 别 在 两 侧 用 延伸 医 固 定 文 染 进 行 固定 ， 延 伸 医 固定 文 染 如 图 10-9 所 示 。 

整个 储 物 盒 取 放 平台 需要 实现 整体 平稳 的 运动 ， 而 各 层 平 台 通 过 3 根 圆柱 滑 轨 文 撑 实 现 
各 个 平台 的 稳定 。 普 通 的 滑动 接触 在 现 有 的 条 件 下 无 法 取得 预期 的 目标 ， 且 清 动 接触 的 洞 请 
在 家 庭 条 件 下 不 容易 进行 维护 ， 润 滑 不 足 会 导致 平移 不 够 流畅 ， 因 此 采用 直线 轴承 进行 连接 。 
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直线 轴承 是 一 种 以 低 成 本 生产 的 直线 运动 系统 ， 用 于 无 限行 程 与 圆柱 轴 配 合 使 用 ， 钢 球 以 极 
小 的 摩擦 阻力 旋转 ， 从 而 能 获得 高 精度 的 平稳 运动 。 由 于 平台 使 用 三 根 偏 置 圆柱 支撑 ， 会 产 
生 一 定 的 弯曲 应 力 ， 因 此 选用 加 长 型 方法 兰 的 直线 轴承 LM8LUU。 
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图 10-7” 储 物 盒 取 放 平台 图 10-8 ”延伸 辟 














一 一 





a) b) 
图 10-9 ”延伸 锅 固 定 支 染 
a) 延伸 臂 左 固定 支架 _b) 延伸 臂 右 固定 支架 

由 于 加 工 误 兰 ， 圆 柱 请 轨 的 平行 度 在 运行 时 并 不 十 分 准确 ， 使 得 各 融 度 的 圆柱 导轨 的 中 
心算 会 产生 变化 ， 使 得 平台 运行 时 产生 挤 压 变形 ， 增 加 摩 控 力 ， 影 啊 平 台 的 流畅 运行 ， 因 此 
在 设计 时 直线 轴承 在 竖 直 方 同上 进行 过 和 忽 配 合 ， 但 在 水 平方 同上 留 有 一 定 间 隙 ， 使 得 整体 系 
统 中 不 会 对 圆柱 守 轨 产生 较 大 的 内 部 零件 之 则 的 应 力 。 中 心 调 整 北 置 如 图 10-10 所 示 。 

(3) 同步 市 传动 机 构 设 计 

1) 设计 功率 。 在 家 性 环境 下 ， 传 动机 构 的 工作 条 件 民 好 是 不 会 大 功率 连续 工作 ， 所 以 选 
择 工 况 系 数 K,，=1 。 工 作 时 ， 步 进 电动 机 的 最 大 输出 功 识 为 9.2W， 因 此 设计 功 座 约 为 
Pk P=02W: 

2) 小 和 带 轮 转速 计算 。 将 托 板 的 上 升 速度 设计 为 S0mnm/s， 则 小 市 轮转 速 为 托 板 上 升 速度 
除 以 丝 杠 导 程 (4mm )， 求 得 转速 为 12.5r/s 《750r/min)。 

3) 同步 带 选 型 。 根 据 圆 弧 齿 同 步 带 ( 见 图 10-11) 的 选 型 原则 ， 选 择 3M 圆 弧 齿 同步 带 ， 
小 带 轮 齿 数 为 30。 



































要 
图 10-10 中心 调整 装置 图 10-11 辆 孤 类 同步 带 





圆 踊 齿 同步 市 市 齿 和 市 宽 尺 寸 〈 依 据 JB/T 7512.1 一 1994) 
市 型 ，3M 

人 距 pb: 3 

齿 高 h: 1.22 

齿 顶 圆 角 半径 x。 0.87 

齿 根 圆 角 半径 疡 :0.24 一 0.30 
齿 根 厚 s: 1.78 

齿 形 角 26: 14 

带 高 hs: 2.40 

带宽 : 6，9，15 

4) 小 带 轮 节 圆 直人 竹 








d = = 28.66mm (10-1) 
ZT 
5) 大 市 轮 齿 数 
人 (10-2) 
nn, 3 
6) 大 带 轮 节 圆 直径 
d, = 2 -47.77mm (10-3) 
VI 
7) 市 速 
Pe (10-4) 
60x1000 
8) 初 定 轴 间距 
0.7 (qd +qd,) <a, <2(4 +q,)) (10-5) 


由 式 (10-5) 得 : 53.501mm 三 ao 三 152.86mm ， 根 据 设 计 意 图 ， 选 定 ay =152.8mm 。 
9) 市 长 
有 2 
[=2a, +174 + 4) + "0 = 426.1926mm (10-6) 


Uo 





根据 “ 圆 孤 疮 同步 带 长 度 系列 ”选取 标准 ， 节 线 长 上 ,= 459mm 
10) 带 齿 数 





元 
Pe (10-7) 
pp 3 
11) 实际 中 心 矩 
M=4L,-2n(d +d,)=1355.11 (10-8) 
Do Ny ee /0 (10-9) 
ad Te 169.38mm 








12) 安装 量 和 调整 量 的 计算 
通过 JB/T 7512.2 一 1994 查 表 得 ,安装 量 7=1.02+6=7.02 (双边 挡 圈 ), 调整 量 S = 0.76 。 


因此 
@ 
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a =a-1=162.36mm (10-10) 
a =a+S=170.14mm (10-11) 
13) 螨 合 齿 数 
. d,—d 
-il 05- 生 -和 =14 (10-12) 
a 


14)〉 顺 合 齿 数 系数 

2m=14>6 一 路 合 齿 数 系数 天, =1 

15) 基本 额定 功率 。 查 表 “ 基 本 带 轮 功率 (JB/T7512.3 一 1994)” 得 ， 记 =0.068kW 。 
16) 带宽 








P 
b=1.17b, 2 (10-13) 
KLK,ho 


计算 得 : po =6mm ， 及 =9.42mm ，bi 二 bh， 因此 选择 b=15mm 的 同步 市 。 

(4) 动力 装置 选择 ” 因 整 套装 置 主要 应 用 于 家 败坏 境 ， 故 动力 系统 的 体积 不 守 过 大 。 万 
外 ， 因 设计 载荷 相对 较 小 ， 因 此 选用 步 进 电动 机 进行 驱动 。 为 使 系统 较为 安全 ， 并 降低 运行 
时 的 噪声 ， 采 用 低 电 压 直 流 输入 。 升 降 结 构 传 动 采 用 丝 杠 传动 ， 传 动 效率 局 ， 有 灵敏 度 局 并 且 
定位 准确 ， 满 足 所 需 的 结构 要 求 。 浚 珠 丝 杠 的 导 程 为 4mnm， 张 动 扭矩 为 

FI 15.98x4 
” 27 2x3.14x0.94 
式 中 一 一 轴 向 负载 ，N:; 
大 -一 丝 杠 导 程 ，mi 
11 一 一 丝 杠 正 效率 。 

升降 平台 步 进 电动 机 的 选择 : 根据 广 家 提供 的 电动 机 参数 ,选择 57BYGH301 混合 式 〈 永 

磁感应 子 式 ) 步 进 电动 机 ， 有 基体 参数 见 表 10-2。 




















N:.m=0.990N .m (10-14) 








表 10-2 57BYGH301 混合 式 步 进 电动 机 参数 





电感 /mH 
0.8 


根据 步 进 电动 机 的 频 矩 特性 ， 该 步 进 电动 机 在 较 低 转速 条 件 下 的 转 矩 较 大 ， 整 体 性 能 满 
足 设 计 要 求 。 

取 放 平台 步 进 电动 机 的 选择 : 15kg 重 物 ， 摩 擦 系数 约 为 0.05， 则 所 受 摩 探 力 约 为 7.3N， 
由 于 安装 误差 ， 实际 摩擦 力 最 大 为 10N， 所 选用 同步 带 轮 直 径 为 Somm， 则 所 产生 的 转 窍 约 为 
7.5Nx0.05m=0.37N:-m。 根 据 此 转 矩 的 大 小 ， 选 取 的 电动 机 为 42BYGH 混合 式 步 进 电 动机 ， 其 
基本 参数 见 表 10-3。 

1〉 电 动机 型 号 : 42BYGH403。 

2) 应 用 场合 : 监控 设备 、 医 疗 仪 器 、 工 业 自 动 化 设备 。 

3) 步 进 角 : 1.8° 








电 
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\- 


4) 温 升 : 65K。 
5) 绝缘 电阻 ; DC。500V 100MQ (最 小 )。 
6) 工作 温度 : -10 一 SSC 。 


\- 


表 10-3 42BYGH403 混合 式 步 进 电动 机 的 基本 参数 


2. 坚 直 升降 装置 设计 

(1) 设计 方案 巧 挂 贷 架 左 上 方 用 螺丝 固定 平板 ， 在 平板 上 方 回 定 电动 机 ， 同 步 市 轮 工 、 
同步 珊 轮 开 分 别 与 同步 带 相 吵 合 构成 同步 融 机 构 ， 同 步 市 轮 通 过 键 配 合 安 钱 在 传动 轴 上 ， 传 
动 轴 则 通过 固定 轴承 安装 在 平板 上 ， 其 上 还 安装 有 卷 线 位 和 具 轮 ， 钢 丝 绳 的 一 端 固定 在 传动 
轴 的 卷 线 位 上 ， 男 一 问 通 过 定 滑轮 固定 在 用 于 容纳 储 物 单元 的 托盘 上 ， 电 动机 转动 通过 同步 
带 机 构 降 速 传 到 传动 轴 上 ， 使 卷 线 简 转动 ， 进 而 带动 托盘 升降 。 托 盘 背 部 安装 着 的 两 个 滑 块 ， 
可 治 焊 接 在 巧 挂 货架 后 方 的 两 根 直线 导轨 滑动 ， 以 此 保证 储 物 单 元 在 竖 直 运动 中 的 平稳 性 。 
平板 上 锁 死 机 构 的 衔 铁 在 系统 断 电 后 将 脱离 电磁 铁 的 吸附 ， 卡 住 传动 轴 上 的 齿轮 ， 使 传动 轴 
终止 转动 ， 防 止 托 盘 在 储 物 单 元 及 目 身 的 重力 下 突然 滑 下 伤 及 用 户 。 

(2) 动力 装置 选择 ”托盘 、 储 物 单元 及 物品 的 总 质量 为 20kg， 产 生 的 外 力 为 F=200N。 
托盘 带动 储 物 单元 作 匀 速 升 降 运 动 ， 高 度 为 1.5m， 用 时 5s， 因 此 速度 为 v=0.3m/s。 图 10-12 
为 竖 直 升降 装置 机 构 运 动 徐 网 。 

1) 电动 机 类 型 选择 。 电 动机 选用 永 磁 感应 子 式 步 进 电动 机 。 

2) 确定 电动 机 功率 。 

传动 装置 总 效 雍 : 71 汪 11 带 X11 轴承 XN 关 线 和 =0.96xX0.992x0.95=0.89。 

电动 机 所 需 功 率 : Pj=Fyv/n s=200x0.3/x0.89=67.4 (W )。 

































































小 带 轮 电动 机 





卷 线 简 


图 10-12 ” 竖 直 升降 装置 机 构 运 动 简 图 








3) 确定 电动 机 转速 。 设 小 带 轮 、 大 带 轮 、 卷 线 简 的 半径 与 转速 分 别 为 mm 、 7P、 六 和 7、 
12、713， 三 者 之 间 的 关系 为 
A Wet 
Nn, = 1 (10-15) 
2T011373 = 


当 y=0.3m/s 时 


© 
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Wa "2 KS 





二 可 r/s = 2r/s =120r/min (10-16) 
2N1r, 2xNTxX25 
ni 即 为 竖 直 升降 装置 所 用 电动 机 的 转速 ， 可 通过 控制 频率 来 控制 电动 机 转速 。 


4) 人 确定 电动 机 型 号 。 根 据 以 上 选用 的 电动 机 类 型 、 所 需 的 额定 功率 及 同步 转速 ， 选 定 永 
人 磁感应 子 式 步 进 电动 机 ， 型 号 为 85BYGH203， 如 图 10-13 所 示 。 其 主要 性 能 参数 为 : 4 相 制 ， 
24V 工作 电压 ，4A 工作 电流 ， 功 率 为 965W， 静 转 矩 为 5.0N:m， 步 距 角 为 0.9/1.8。。 

电动 机 驱动 费 使 用 两 相 泥 合 步 进 电 动机 驱动 器 ,型 写 为 SH2046M，, 该 驱动 右上 其 有 噪声 低 、 
效率 高 、 电 压 范 围 宽 、 设 置 灵 活 、 运 行 平 稳 、 定 位 准确 等 优点 。 

Q 输入 电源 接口 : 采用 直流 供电 ，DC: 24V，3A。 

@ 电动 机 接口 : 85BYGH203 步 进 电 动机 为 二 相 四 线 电动 机 ， 可 直接 与 驱动 器 相连 。 

(3) 输入 信和 号 接口 : SH2046M 型 步 进 电动 机 驱动 器 内 部 的 接口 电路 都 采用 光 耦 信号 隔离 ， 
当 信和 号 幅度 为 SV， 不 加 外 接 限 流 电 阻 。 

4) 相 电流 设 定 : SH2046M 型 细 分 驱动 器 采用 拨 位 开关 设 定 相 电流 及 细 分 数 ， 其 中 拨 位 5 
是 半 流 使 能 ， 拨 位 6 是 单 双 脉 冲 设 定 。 驱 动 右 细 分 设 定 后 电动 机 的 步 距 角 等 于 电动 机 的 整 步 
步 距 角 除 以 细 分 数 。 

() 安装 : 驱动 堪 采 用 带 散 热 器 的 外 过 结构 。 























图 10-13 85BYGH203 电动 机 
a) 电动 机 实物 图 b) 电动 机 结构 尺寸 图 
(3) 同步 市 轮 传 动机 构 设 计 “同步 珊 轮 传动 机 构 由 一 根 内 周 表面 设 有 等 间距 齿 的 封闭 环 
形 胶带 和 相应 的 带 轮 组 成 。 运 动 时 ， 带 齿 与 带 轮 的 齿 权 相 吵 合 传递 运动 和 动力 ， 是 一 种 员 合 
传动 ， 因 而 具有 齿轮 传动 、 链 传动 和 平 带 传动 的 各 种 优点 。 
采用 同步 之 传动 具有 准确 的 传动 比 ， 无 滑 差 ， 可 获得 恒定 的 速 比 ， 传 动 平 稳 ， 能 吸 振 ， 噪 
声 小 ， 传 动 比 范 围 大 ， 一 般 可 达 1:10。 人 允许 的 线 速 度 可 达 50m/s， 传 递 的 功率 从 几 瓦 到 几 百 瓦 ， 
甚至 上 干 岂 , 传动 效率 局 ,一般 可 达 98%,， 结 构 紧 凑 , 无 需 调 滑 , 无 污染 , 一般 使 用 温度 为 -20 一 
80*C，v<50m/s，P<300kW，i<10， 对 于 要 求 同 步 的 传动 也 可 用 于 低速 传动 ， 因 此 可 在 不 允许 有 
污染 和 工作 环境 较为 恶劣 的 场所 下 正和 常 工 作 。 表 10-4 为 同步 带 轮 传动 机 构 设计 参数 。 


表 10-4 同步 带 轮 传动 机 构 设 计 参 数 
df/mm dp/mm h/mm 





























及 管理 系统 


同步 这 传 动机 构 间 的 传动 比 =zx/zi=2， 通 过 三 维 建 模 软 件 可 测 得 小 市 轮 包 角 


o=134.37”>120 
表 10-5 同步 


; rr 


小 市 轮 齿 数 


人 
省 
塌 
起 
tt 
澡 
加 
HA 
Et 


CA 


Ci 


CN 


了 市 齿 数 


因此 满足 设计 要 求 。 同 步 
带 传动 机 构 的 相关 设计 计算 


审 传 动机 构 的 相关 设计 计算 见 表 10-5。 


计算 参数 及 其 选 定 
3 
2 
25 


d = 了 ce -23.87 
nT 
Dl 
2Z, = iz = 并 了 =50 
1 
d, = Pb =57.75 
nT 
46.99 


2 
初 定 节 线 长 ， =20 + (dtd) + em 418.8, ao 取 150 
40 





Sa 
60x1000 
z=L,/p, =140 


M+VM’ -32(00 一 7 
8 实际 中 心 距 而 桓 M = 47 一 2 d +d)=1223.044= 148.13 











各 轮 人 确定 后 ， 通 过 人 查阅 设计 手册 可 确定 同步 市 的 相关 尺寸 ， 见 表 10-6。 
表 10-6 同步 带 的 相关 尺寸 
(4) 传动 轴 设 计 及 校 核 ”传动 轴 的 结构 尺寸 如 图 10-14 所 示 。 
Rad.8 CARal6 区 /Ral JRal.6 有 
3 IE 对 -sens WhooaeD | 
对 CN + 
2 i S. Ral6 全 中 G 广 全 03S 





图 10-14 ”传动 轴 
将 传动 轴 转 化 成 横 截 面积 4=TD214=Tx8 714=50.3mm2 ， 长 度 L=330mm 的 光 轴 ， 即 按 


阶 樟 轴 处 为 最 小 槛 截面 积 进行 校 核 。 
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按照 步 进 电 动机 输出 最 大 功率 Pl=96W 计算 ， 传 动 轴 上 功率 P=92.16W， 则 有 
续 矩 ， 了 = 2050P _ 9.5Sx92. lo\. 733N.m 
120 
圆周 力 : 人 
径 问 力 : 已 =Ftana=1.83Nxtan20” =0.67N 


绘制 水 平面 要 和 窍 岁 ， 如 网 10-15a 所 示 。 











轴承 文 反 力 
FL 0.67x330 
N178N 一 
NHI1 154 5 (10-17) 
FL 0.67x330 
J NL LN = 
NH2 六 205 5 (10-18) 
截面 C 左右 侧 弯 算 
My = Myc = Mic: = Fa x124.5=221.61IN .mm (10-19) 
绘制 垂直 面 弯 矩 图 ， 如 网 10-15b 所 示 。 
轴承 文 反 力 : 
FL 1.83x330 
NdS5N 一 
NVI1 L 124 4 (10-20 ) 
FL 1.83x330 
二 UN 一 
Ny L 505 5 (10-21) 
截面 C 左右 侧 弯 算 : 


M,=M,c =M 


V,C+ 


校 核 传动 轴 : 转 拓 产生 的 扭 毅 应 力 按 脉 动 循环 变化 ， 取 a=0.6 
C 截面 右 侧 为 危险 截面 ， 由 强度 校 核 公开 


=VM*+(aT) =V643.21* +(0.6x7.33)2N.mm = 643.23(N.mm) (10-23) 


= FF X124.5 = 603.83N .mm (10-22) 











M 
Ouc = 一 气 = 0 Mpa =12.80MPa < [c_ ]= 55MPa 
“二 (10-24) 
80 32 


因此 ， 用 传动 轴 最 小 截面 进行 校 核 时 满足 设计 强度 要 求 。 


rT] | FNH?2 | FR] FNV2 
FNv1 


a 
MH=221.61N :mm Nf =603.83N :mm 


图 10-1$ 弯 矩 图 
a) 水 平面 弯 矩 图 b) 垂直 面 弯 矩 图 


校 核 带 有 固定 架 的 轴承 : 轴 端 直径 4 = 8mm ， 传 动 轴 转 速 n =120r/min ， 初 选 1200 型 调 
心 球 轴承 ， 由 于 只 承受 径 同 力 ， 所 以 入 1， 天 0， 碍 表 得 : C=5.5kN。 
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在 水 平面 上 的 径 问 载 何 

_FL 0.67x330 
LL 124.5 
FL 0.67x330 


N=1.78N (10-25) 

















用 N=1.11IN 10-2 
NH2 705 5 (10-26) 
在 馈 王 面 上 的 竹 问 载 答 
FL 1.83x330 
二 SN 一 
NVI1 124 5 (10-27 ) 
FL 1.83x330 
Nes302N 10-2 
Wy 705 5 (10-28) 
可 得 两 轴承 处 的 径 回 载 衙 
. 3 ee . 
J a a =5.2N (10-29 ) 
F = FE +F =3.22N (10-30) 
P= Xr +YF, =(Ux5.2+0x0) N=5.2N (10-31) 
P= XrF, +YF,=Ux3.22+0x0)N=3.22N (10-32 ) 
10 10 
6 C 3 6 
有、 A ~ | | h=1.67x10°h (10-33 ) 
60n\ fB 60x60\1.1x92.16 


结果 显然 满足 使 用 要 求 ， 故 1200 型 调 心 球 轴承 符合 寿命 要 求 。 

3. 水 平 拖 动 装置 设计 

(1) 设计 方案 ”水 平抑 动 装置 主要 由 步 进 电动 机 和 乃 挂 货架 上 的 辱 干 定 滑轮 组 成 ， 电 动 
机 固定 在 平板 上 ， 其 转轴 上 安装 有 卷 线 简 ， 钢丝 绳 依靠 定 滑轮 的 导向 作用 ， 可 带动 储 物 单元 
取 放 装置 的 滑 块 作 水 平 运动 。 

(2) 动力 装置 选择 ”动力 装置 选用 85BYGH101 型 步 进 电动 机 。 

1) 转 矩 校 核 。 储 物 单元 取 放 装置 在 开始 1=0.2m 内 完成 加 速 ， 用 时 #4， 在 最 后 1'=0.2m 内 完 
成 减速 ， 用 时 #4， 中 间 b=0.8m 为 匀速 运动 ， 用 时 pp， 整个 水 平 运 动 要 求 5s 内 完成 ， 得 以 下 方程 组 














1 (10-34) 
v= al 


21 +t, =5 


昌 
dd 


t =1.23s 
tl, =2.58 
v= 0.32m/s 
a=0.256m/s” 
储 物 单元 取 放 装置 及 载荷 的 极限 重量 为 =200N， 滑 块 与 导轨 的 摩擦 系数 取 0.3， 则 水 平 
方向 的 摩擦 阻力 为 太 uFj=0.3x200N=60N。 
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设 水 平方 向 的 拉力 为 玉 ， 由 Fa， 可 得 f=65.12N。 叉 卷 线 半径 r=17.5mm， 因 此 ， 需 
要 的 转 矩 为 了 = 下 =6$.12x0.017SN.m=1.14N.m 。 
卷 线 简 卷 线 的 最 大 线 速 度 即 为 0.32m/s， 所 以 角速度 为 











ee (10-35) 
+ 0.0175 
转速 为 
ww 18.29 (10-36) 





到 TS 一 2.9T/S 
2T 2 


因为 步 进 电动 机 85BYGH101 步 距 角 为 0.9/1.8”， 所 以 400pps (脉冲 数 / 秒 ) 对 应 转速 为 
lr/s， 当 转速 为 2.9rs 时 ， 对 应 的 频率 为 1.16kpps， 可 图 10-16 得 此 时 电动 机 能 提供 的 转 算 为 
2.1Nm>l1.14Nm， 因 此 满足 转 矩 要 求 。 又 考虑 到 在 使 用 中 柜子 水 平方 癌 的 长 度 会 更 大 ， 因 此 
需要 的 转 矩 会 比 理论 计算 值 稍 大 一 些 ， 故 选用 此 步 进 电动 机 ， 可 保证 足够 的 转 矩 余 量 


85BYGHI03 
测试 条 件 : SH-2046D 2 细 分 








MC sO0Y¥ 3A 


Nm 











IK 2K 3K 4K 5K pps 
图 10-16 ”85BYGH 系列 电动 机 和 矩 频 特性 图 
2) 功率 校 核 。 储 物 单元 取 放 装置 水 平方 向 运动 的 最 大 速度 为 0.32m/s， 受 到 的 最 大 拉力 
为 f=65.12N， 因 此 ， 水 平 运动 的 最 大 功率 为 
P= Fv=65.12x0.32W = 20.84W (10-37) 
对 于 85BYGH101 步 进 电动 机 ， 当 角速度 中 =18.29rad/s ， 对 应 的 频率 为 1.16kpps， 同 样 
查 图 10-16， 可 得 此 时 电动 机 能 提供 的 转 甜 为 2.INm， 因 此 它 能 提供 的 功率 为 
P=w7=18.29x2.1W = 38.4W>20.84W (10-38) 
因此 85BYGH101 步 进 电动 机 满足 实际 需要 的 功率 。 


10.3.3 ”控制 电路 设计 

工 . 电路 路 总 总 体 设 计 

电路 板 放 置 在 悬挂 货架 左上 方 的 工作 平台 上 ， 用 四 个 铜 柱 固定 住 四 脚 。 该 电路 是 以 单 片 
机 STC89C52 为 核心 芯片 构成 的 最 小 系统 ， 包 括 电源 模块 、 唱 振 电 路 、 复 位 电路 、 串 口 电 路 
等 ， 如 图 10-17 所 示 。 

2. 控制 模块 设计 

(1) STC89C52 单片机 ”AT89S52 单片机 具有 8K 字 市 程序 存储 空间 ，256 字 节 数据 存储 


© 

















第 10 章 高 处 空间 物品 存放 及 管理 系统 





空间 , 没有 内 带 EEPROM 存储 空间 , 而 STC89C52RC 单片机 具有 8K 字 节 程序 存储 空间 , 512 
字 节 数据 存储 空间 , 内 带 4K 字 节 EEPROM 存储 空间 ,可 直接 使 用 串口 下 载 , 故 采用 STC89C52 
单片机 ， 如 图 10-18 所 示 。 

STC89C52 是 一 种 低 功 耗 、 高 性 能 CMOS8 位 微 控 制 器 ， 具 有 8K 系统 可 编程 Flash 存储 
器 ， 芯 片 外 形 尺 寸 如 图 10-19 所 示 。 在 单 芯 片上， 拥有 灵巧 的 8 位 CPU 和 系统 可 编程 Flash， 
使 得 STC89C52 为 众多 骸 入 式 控制 应 用 系统 提供 高 灵活 、 超 有 效 的 解决 方案 。STC89C52 具有 
以 下 标准 功能 :8K 字 节 Flash，512 字 节 RAM，32 位 IO 口 线 ， 看 门 狗 定 时 器 ， 内 置 4KB 
EEPROM，MAX810 复位 电路 ， 三 个 16 位 定时 右 / 计 数 右 ， 一 个 6 回 量 2 级 中 断 结构 ， 全 双 工 
串 行 口 。 另 外 STC89C52 可 降 至 0Hz 静态 逻辑 操作 ， 文 持 2 种 软件 ， 可 选择 节 电 模式 。 衬 朵 
模式 下 ，CPU 停止 工作 ， 人 允许 RAM、 定 时 器 /计数 器 、 串 口 、 中 断 继续 工作 。 掉 电 保护 模式 
下 ，RAM 内 容 被 保存 ， 振 沪 髓 被 冻结 ， 单 片 机 一 切 工 作 停 止 ， 直 到 下 一 个 中 断 或 硬件 复位 为 
止 。 最 高 运作 频率 为 35Mhz，6T/12T 可 选 。 
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图 10-17 最 小 系统 电路 图 
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图 10-18 STC89C52 单片机 世 图 10-19 STC89C52 单片机 芯片 外 形 尺 寸 

(2) MAX232 忆 卢 “图 10-20 为 MAX232 芯片 。MAX232 芯片 是 美 信 公司 专门 为 电脑 的 
RS-232 标 准 串 口 设计 的 单 电源 电 平 转换 心 片 ， 使 用 +SV 单 电源 供电 。 

第 一 部 分 是 电荷 泵 电路 。 由 1、2、3、4、5$、6 脚 和 4 只 电容 构成 ， 功 能 是 产生 +12V 和 
-12V 两 个 电源 ， 提 供给 RS-232 串口 电 平 的 需要 。 

第 二 部 分 是 数据 转换 通道 。 由 7、8、9、10、11、12、13、14 脚 构 成 两 个 数据 通道 ， 其 
中 13 脚 (RIIN)、12 脚 (R10UT)、11 脚 (TIIN)、14 脚 CTIOUT) 为 第 一 数据 通道 ，8 脚 
(R2IN)、9 脚 (R20OUT)、10 脚 (T2IN)、7 脚 CT2OUT) 为 第 二 数据 通道 ，TTL/CMOS 数 
据 从 TIIN、T2IN 输入 ， 转 换 成 RS-232 数据 从 TIOUT、T2OUT 送 到 电脑 DB9 插头 ， DB9 插 
头 的 RS-232 数据 从 RIIN、R2IN 和 输入， 转换 成 TTL/CMOS 数据 后 从 RIOUT、R2OUT 输出 。 

第 三 部 分 是 供电 。15 脚 GND、16 脚 Vcc (+SV )。 

MAX232 芯片 具有 以 下 特点 : 符合 所 有 的 RS-232C 技 术 标 准 ; g@O 只 需要 单一 +$V 电源 供电 ; 
@@) 片 载 电 和 三 人 汞 具有 升 于 、 电 压 极 性 反 转 能 力 ， 能 够 产生 +10V 和 -10V 电压 ，) 功 耗 低 ， 典 型 供电 



































电流 5mA; @ 内 部 集成 2 个 RS-232C 张 动 器 ; 6) 高 集成 度 ， 片 外 最 低 只 需 4 个 电容 即 可 工作 。 





图 10-20 MAX232 世 


3. 电源 管理 模块 

室内 高 处 至 闻 物 品 存放 及 管理 系统 的 电源 模块 主要 是 为 四 台 步 进 电 动机 、 软 件 管理 平台 
等 模块 进行 供电 ， 由 于 不 同 模块 需要 的 电源 有 不 同 的 电压 要 求 、 功 率 要 求 等 ， 所 以 控制 电路 
的 电源 模块 是 该 系统 硬件 系统 的 重要 部 分 。 
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电源 模块 包括 AC-DC 开关 电源 模块 和 LM2596 开关 电压 调节 器 。AC-DC 开关 电源 模块 
的 输入 为 电压 有 效 值 220V、 频 率 50Hz 的 交流 电 ， 输 出 为 电压 有 效 值 24V 的 直流 电 。 为 满足 
不 同 模块 对 不 同 电源 的 要 求 ， 电 源 模块 在 硬件 设计 上 ， 采 用 了 先进 的 压 甜 调节 器 ， 在 节省 控 
制 电源 数量 的 同时 ， 保 证 了 系统 的 功率 需求 和 稳定 性 。 

四 台 步 进 电动 机 的 供电 电压 均 为 24V， 直 接 从 AC-DC 电源 模块 获得 电能 。STC89C52 单 
片 机 等 相关 芯片 的 供电 电压 为 SV， 采 用 LM2596 DC-DC 模块 供电 。 

(1) AC-DC 开关 电源 图 10-21 为 一 种 脉冲 宽度 调制 式 高 频 开 关 电 源 ， 型 号 为 
A-150-24， 单 端 式 品 体 管 连接 方式 ， 输 入 电压 84 一 264V， 输 出 电压 24V， 输 出 电流 6.5A， 
输出 功率 136W， 输 出 纹 波 噪 声 80mV， 工 作 效 率 83%， 输 出 电压 精度 0.3%， 电 压 调 整 率 
5%， 人 负载 调整 率 $%。 之 所 以 选择 该 开关 电源 ， 是 因为 其 价格 低 、 效 率 高 、 体 积 小 、 重 量 
轻 、 工 作 温 度 低 ， 软 启动 电流 可 有 效 降 低 AC 输入 冲击 ， 内 装 EMI 滤波 器 ， 纹 波 极 小 ， 有 
短路 保护 、 过 载 保护 等 功能 。 

(2) LM2596 开关 电压 调节 器 ”图 10-22 为 LM2596 开关 电压 调节 器 。LM2596 开关 电压 
调节 占 是 降 压 型 电源 管理 单 片 集成 电路 ， 能 够 输出 3A 的 驱动 电流 ， 同 时 具有 很 好 的 线性 和 人 负 
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图 10-21 调制 式 高 频 开 关 电 源 图 10-22 LM2596 开关 电压 调节 器 

该 右 件 内 部 集成 频率 补偿 和 国定 频率 发 生 器 ， 开 关 频 率 为 150kHz， 与 低频 开关 调节 器 
相 比 较 ， 可 以 使 用 更 小 规格 的 滤波 元 件 。 由 于 该 器 件 只 需 4 个 外 接 元 件 ， 可 以 使 用 通用 的 标 
准 电 感 ， 这 更 优化 了 LM2596 的 使 用 ， 极 大 地 人 简化 了 开关 电源 电路 的 设计 。LM2596 电路 图 
如 图 10-23 所 示 。 








12V 固 定 直流 输入 





680hF 220pF 


图 10-23 LM2596 电路 图 





该 句 件 在 特定 的 输入 电压 和 输出 负载 条 件 下 , 输出 电压 的 误差 可 以 保证 在 44% 范 围 内 ， 振 
沪 频 率 误 差 在 +15% 范 围 内 ;可 以 用 仅 80uA 的 待机 电流 ， 实 现 外 部 断 电 ; 有 共有 上 自我 保护 电路 
《一 个 两 级 降 频 限 流 保护 和 一 个 在 异 弟 情况 下 断 电 的 过 温 完 全 保护 电路 )。 
LM2596 开关 电压 调 市 费 的 主要 性 能 特点 : 
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1)3.3V、5V 和 12V 的 固定 电压 输出 , 并 具有 可 调 电 压 输 出 能 力 , 可 调和 输出 电压 范围 (1.2 一 
37V) +4%。 

2) 输出 线性 好 且 负 载 可 调节 。 

3) 输出 电流 可 高 达 3A， 输 入 电压 可 高 达 40V。 

4) 采用 150kHz 内 部 振荡 频率 ， 属 于 第 二 代 开 关 电 压 调 和 堪 ， 功 耗 小 、 效 率 融 。 

5) 低 功 耗 待机 模式 ，IQ 的 典型 值 为 80pA。 

6) TTL 上 断 电 能 

7) 具有 过 热 保护 和 限 流 保护 功能 。 

8) 外 围 电路 简单 ， 仅 需 4 个 外 接 元 件 ， 且 使 用 容易 购买 的 标准 电感 。 

因 其 上 述 特 点 ，LM2596 开关 电压 调节 堪 第 用 于 高 效率 降 压 调和 器 、 单 族 开 关 电 压 调 和 和 需 
和 正 负 电压 转换 器 。 























10.3.4 ”驱动 程序 设计 


1. 设计 任务 

通过 一 片 C52 和 单片机， 控制 系 统 运 行 时 四 台 步 进 电 动机 的 驱动 器 ， 使 之 带动 功率 各 不 相 
同 的 四 台 步 进 电动 机 ， 完 成 上 位 机 通过 串 行 口 发 出 的 规定 动作 。 为 了 定位 准确 ， 在 各 关键 位 
置 引 入 了 行程 开关 ， 在 运行 时 进行 自我 位 置 矫正 ， 使 得 进行 每 一 个 阶段 时 所 产生 的 误差 不 会 
累积 ， 整 体位 置 误差 控制 在 5% 以 内 。 

2. 设计 难点 

STC89C52 只 有 三 个 定时 器 ,， 并且 其 中 之 一 需要 分 配给 串口 进行 通信 。 每 个 步 进 电动 机 即 
使 通过 驱动 器 来 控制 ， 由 于 需要 不 同 的 脉 神 频率 ， 使 得 要 精确 控制 步 进 电动 机 需要 对 每 一 台 
步 进 电动 机 分 配 一 个 定时 器 /计数 器 。 这 就 使 得 C52 本 身 的 便 件 资源 比较 紧张 。 因 此 需要 解决 
的 问题 就 是 如 何 对 有 限 的 系统 硬件 资源 进行 充分 的 利用 。 

同时 ， 各 同步 电动 机 车 被 施加 较 大 负载 会 产生 丢失 精度 的 现象 ， 因 此 必须 通过 行程 开关 
来 进行 定时 的 位 置 校 核 ， 而 这 也 会 产生 另 一 个 问题 ， 即 外 部 中 断 不 够 用 。 因 此 ， 需 要 首先 对 
所 有 行程 开关 的 信号 进行 位 与 操作 ， 之 后 进行 判断 所 产生 的 中 断 源 的 种 类 。 这 束 对 电路 部 分 
提出 了 较 融 的 要 求 。 

整套 软件 系统 需要 模块 化 设计 ， 各 层 之 间 结 构 分 明 ， 关 联 性 仅仅 取决 于 各 层 的 调用 方式 。 
每 层 模块 之 间 的 接口 对 上 一 层 软件 保持 透明 ， 方 便 各 层 之 间 的 调用 。 而 各 个 层级 之 间 相 互 独 
六 ， 保 持 软件 系统 的 扩展 性 与 可 修改 性 。 这 样 可 以 降低 复杂 上 度 ， 使 程序 更 容易 修改 ， 开 友 的 
速度 更 快 ， 并 且 每 层 利 用 紧邻 的 下 层 服 务 ， 更 容易 记 住 每 个 层 的 功能 。 

3. 程序 流程 

图 10-24 为 存放 流程 图 。 整 个 结构 为 自然 顺序 的 循环 , 来 完成 上 位 机 的 一 个 存 或 者 取 
的 任务 。 上 位 机 先 取出 用 来 存放 物品 的 盒子 , 然后 用 户 将 所 要 存放 有 的 东西 放 入 取 来 的 盒子 
之 中 , 之 后 问 单 片 机 发 出 信和 号， 单 厂 机 将 储 物 合 上升 到 储 物 柜 之 中 ,将 装 有 所 存放 东西 的 
储 物 盒 返 回 之 前 的 位 置 ， 完 成 整个 存放 过 程 。 而 取 的 过 程 同 样 按照 存放 任务 的 循环 ， 将 所 
需 的 储 物 盒 取 出 ， 然 后 再 放 回 ， 完 成 取出 物品 的 循环 。 存 放 取 出 的 过 程 ， 通 过 上 位 机 进行 
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控制 , 中 间 各 个 运行 阶段 的 间隔 时 间 完 全 通过 用 户 来 控制 , 使 得 用 户 进 行 各 阶段 操作 时 不 
会 产生 紧张 的 情形 。 















移动 平台 所 在 位 
置 《〈1 号 储 物 盒 ) 
托 板 未 放下 


上 位 机 通信 
〈 存 / 取 ) 储 
物 盒 编号 


移动 平台 所 在 位 
置 〈1 号 储 物 盒 ) 
托 板 已 放下 


托 板 上 升 


取出 储 物 盒 取出 储 物 盒 









移动 到 目标 
储 物 盒 










移动 到 目标 返回 一 
位 置 位 置 


放 入 储 物 盒 储 物 盒 政 入 
一 号 位 置 

移动 平台 返 放下 托 板 储 

回 一 号 位 置 物 盒 降 下 


图 10-24 存放 流程 图 





4. 串口 通信 协议 

整个 运动 过 程 中 与 上 位 机 的 通信 并 不 频繁 ， 通 信 仪 在 进行 任务 分 配 时 进行 ， 也 束 是 在 每 
次 动作 循环 前 后 进行 数据 传输 与 确认 。 电 路 采用 12MHz 品 体 振 沪 器 , 为 保证 通信 之 间 的 精度 ， 
减少 误 码 的 发 生 ， 采 用 最 高 2400 小 特 率 ， 保 证 与 上 位 机 之 间 通 信 不 会 出 现 信 号 丢失 现象 ， 并 
有 在 软件 系统 中 进行 通信 校 验 的 步 又， 如 CRC32 即 循环 兄 余 校 验 检测 。 串 口 通信 协议 对 照 表 
见 表 10-7 所 示 。 








表 10-7 串口 通信 协议 对 照 表 
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$. 底层 硬件 驱动 程序 设计 

便 件 系统 所 选用 的 步 进 电 动机 型 号 不 同 ， 所 对 应 的 驱动 器 的 型 号 也 不 相同 。 对 于 
STC89C52 来 说 ， 信 号 处 理 所 占 用 CPU 的 时 间 不 宜 过 长 ， 尤 其 在 中 断 之 中 ， 不 适合 进行 大 量 
的 运算 工作 ， 特 别 是 占用 资源 最 高 的 除法 运算 ， 因 此 运算 要 尽量 在 中 断 之 外 进行 ， 并 且 尽 量 
减少 运算 的 次 数 。 对 于 时 间 比 较 敏 感 的 阶段 ， 甚 至 可 以 采用 得 表 法 来 进行 ， 以 空间 复杂 性 来 
减少 时 间 上 的 复杂 性 ， 使 整个 系统 程序 处 理 的 效果 最 高 。 此 外 ， 对 编译 后 的 代码 进行 逆 癌 阅 
读 ， 进 行 反 汇 编 ， 优 化 程序 效率 。 

由 于 定时 器 与 外 部 中 断 源 的 缺少 ， 程 序 尽量 采用 单线 程控 制 ， 完 成 额定 工作 目标 ， 并 且 午 
复 利 用 定时 器 与 中 断 ， 相 互联 系 而 又 彼此 数据 上 保持 独立 ， 使 得 单片机 的 资源 充分 发 挥 作用 。 
10.3.5 系统 软件 开发 

1. 软件 设计 目标 

软件 设计 目标 为 : 

1) 提供 友好 、 易 于 操作 的 用 户 界面 及 详细 的 用 户 使 用 说 明 ， 方 便 普 通用 户 快 速 掌握 软件 
的 使 用 方法 。 

2) 提供 设计 合理 、 实 用 方便 的 软件 功能 ， 方 便 用 户 省 时 省 力 地 完成 对 家 居 物 品 的 管理 。 

2. 软件 功能 介绍 

为 达到 软件 设计 的 目标 ， 保 证 用 户 使 用 方便 、 快 捷 ， 设 计 了 如 图 10-25 所 示 的 软件 功能 


框 染 图 。 
存储 过 期 提醒 
保质 期 提醒 


本 地 信息 搜索 
联网 信息 搜索 


物品 存储 
物品 信息 编辑 


物品 信息 录入 









































































条 码 信 息 搜索 





















基本 信息 编辑 








软件 信息 
使 用 指南 


图 10-25 ”软件 功能 框架 图 
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3. 软件 界面 介绍 

(1) 软件 界面 风格 

1) 界面 主 色 调 为 凸显 和 家庭 温 二 的 桶 黄色 。 

2) 界面 简洁 明快 ， 切 换 流 畅快 速 ， 减 少 用 己 操 作 与 等 符 。 

程序 本 身 昌 然 包含 多 个 界面 ,但 用 户 只 需要 在 同一 个 界面 下 单 击 不 同 的 染 单 与 Tab, 便 可 
快速 切换 到 不 同 界面 ， 界 面 切换 流畅 快速 ， 减 少 用 户 操作 与 等 待 。 软 件 主 界面 如 岁 10-26 所 
示 。 知 用户 想 从 登录 界面 到 添加 物品 界面 ， 只 需 单 击 屏 攻 下端 问 定 的 沫 单项 从 “个 人 信息 ” 
到 “我 的 物品 ” 即 可 。 

(2) 主要 界面 展示 

1) 软件 首页 。 图 10-27 为 软件 首页 ， 当 用 户 长 按 物 品 滑动 列表 中 的 菏 个 物品 的 时 候 会 弹 
出 采 持 。 

















































此 处 显示 当 
前 登录 用 户 












用 户 单 击 此 处 
1 i 0 0 四 | 9 进行 账户 登 
人 录 与 退出 





此 处 为 固定 
菜单 ， 用 户 


可 以 快速 选 | 攻 
全 师傅 方便 面 物品 名 称 : 惩 丸 蝴 上 ME 
择 相应 功能 | oyeioal 存储 日 期 2012.04-10 8 时 39 分 。 存储 











HO@ QQ 回电 
10-26 ”软件 主 界面 













此 处 为 用 品种 类 列表 ， 
单 击 不 同 标签 ， 显 示 不 
同 种 类 物 


， a 3 (HO 0 和 
此 为 物品 滑动 列表 ， 2 了 < 
用 户 可 以 左右 滑动 列 -= -ce 
ee 和 傅 方 便 面 物品 名 称 :入 记 蝴 啡 “ 
、\ Sp 口 仁 : 县 顷 目 ? 让 nD ， = yr 
ee 品 司 全 品 2-04-1 8 时 37 分 存储 日 期 :2012-04-10 8 时 39 分 ER : 人 


言 息 等 操作 四 人 @ 加 忆 
图 10-27 软件 首页 
2) 用 户 信息 管理 界面 。 图 10-28 为 用 户 信息 管理 界面 。 





















[加 中 面 | 国 10:37 
让 家 更 简单 登陆 
此 为 用 户 信 息 管 理 的 注册 资料 编辑 忘记 密码 ”修改 密码 
功能 列表 ， 用 户 可 单 称 NS 
击 不 同 表 项 ， 完 成 登 


孙 注 册 、 信 县 编 辑 、 A 有 :| 
、 密 码 修改 “民事 








10-28 ”用户 信息 管理 界面 
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3) 物品 信息 管理 界面 。 图 10-29 为 物品 信息 管理 界面 。 





国 时 wl 证 1038 
, 登陆 
此 为 物品 信息 管 a rep 
理子 界面 ， 用 户 一 
通过 此 界面 可 以 
完成 物品 信息 输 





入 、 编 辑 等 功能 





图 10-29 物品 信息 管理 界面 
4) 物品 信息 搜索 界面 。 图 10-30 为 物品 信息 搜索 界面 ， 可 搜索 本 地 数据 库 中 存储 的 物品 


信息 。 


















此 为 物品 信息 搜 
索 框 ， 用 尸 可 以 
在 此 输入 搜索 关 
键 子 ， 下 端的 搜 
索 结 朱 列 表 会 实 
时 显示 搜索 结果 


此 为 搜索 结果 的 -Ee 


10-30 物品 信息 搜索 界面 
图 10-31 为 联网 信息 搜索 ， 通 过 互联 网 搜索 物品 信息 。 










此 为 物品 种 类 选 
择 框 ， 用 户 可 以 
在 此 选择 物品 种 
类 ， 搜 索 结 末 将 
随 厦 物品 种 类 不 
同 而 不 同 













选择 搜索 网 站 








10-31 联网 信息 搜索 


5) 物品 信息 提醒 界面 。 图 10-32 为 物品 信息 提醒 界面 。 
ENN Riod 
公共 用 户 让 家 更 简单 司 陆 
存储 超期 查 醴 保质 期 捍 酬 
用 户 可 以 通过 此 界 
面 查 看 超过 规定 存 


储 日 期 的 物品 以 及 
即将 过 期 或 者 已 经 
过 期 的 物品 








图 1 10-32 物品 信 自 提醒 界 面 
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此 为 用 户 帮助 主 界 
面 ， 用 户 可 以 在 此 
设置 保质 期 提醒 的 
时 间 及 物品 最 长 丰 





储 时 间 ， 也 可 以 碍 
看 用 户 帮 助 文档 及 
软件 信息 介绍 





图 10-33 用户 帮助 界面 


4. 功能 模块 详细 说 阴 

(1) 物品 信息 管理 模块 ”通过 本 模块 ， 用 户 可 以 实现 物品 的 存储 、 取 出 、 信 息 编 辑 、 信 
县 录入 等 功能 ， 如 网 10-34 所 示 。 

1) 添加 物品 

(DD 用 户 信 息 输入 。 图 10-35 为 添加 物品 的 用 户 界 面 ， 用 户 可 以 通过 有 末 单 选择 使 用 条 形 码 
方式 输入 信息 ， 也 可 以 手动 输入 ， 物 品 的 图 像 可 以 通过 单 击 其 图 像 ， 调 用 相机 拍摄 实现 动态 
添加 。 








开始 


用 户 输 入 物品 信息 


i 


> 


用 户 选 择 存 储 物 上 


Bo 
什 
仿 


从 柜子 取 用 户 选择 的 箱子 


用 户 确认 ， 物 品 入 箱 


加 | | 11:32 









让 家 要 简单 2s 


单 击 此 区 域 ， 调 



















箱子 放 回 柜子 用 系统 相机 ， 拍 i 
摄 物 品 照片 Th AAA 


{上 百 和 机 1 


物品 信息 写 入 数据 库 I 国 单 击 此 区 域 ， 


开始 保存 物品 









i 












单 击 此 菜单 项 ， 属 l 
通过 条 形 码 输入 

结束 物品 信息 © 

具 邓 形 码 输入 径 交 物品 

图 10-34 物品 信息 管理 模块 图 10-35 添加 物品 的 用 户 界 面 





Go 提 摄 物品 照 上 请 。 单 击 备注 所 指 区 域 ， 调 用 系统 相机 ， 担 摄 照 上 请， 拍摄 完成 后 照片 目 动 
需 充 备注 所 指 区 域 。 
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a， 调 用 相机 ， 拍 摄 物 品 照片 ， 如 图 10-36 所 示 。 





图 10-36 ”拍摄 物品 照片 
b. 照片 填充 备注 所 指 区 域 ， 如 图 10-37 所 示 。 


照片 填充 备 
注 所 指 区 域 





10-37 照片 填充 备注 区 域 


(3) 条 形 码 扫描 物品 信息 。 单 击 图 中 的 相应 位 置 ， 局 动 条 形 码 扫描 模块 ， 扫 描 物 品 信息 对 
应 的 条 形 码 。 以 一 本 书 的 一 维 码 扫 摘 为 例 ， 模 块 的 使 用 过 程 如 图 10-38 所 示 。 扫 摘出 结果 后 ， 


可 上 网 搜索 该 产品 的 相关 信息 并 显示 。 
几 
谷歌 图 书 ; C++ 纺 理 思 轴 [ 翅 克 尔 了 一 Bruce) 
癌 亲 种 (Allson, Chuc 刀 , 恬 威 可 ] [510pp,] 











i A 17T2 412 AM 
打开 产品 搜索 征 。 打 开 图 书 搜索 是 搜索 旧书 内 容 





a) b) 
10-38 条 形 码 的 扫描 过 程 
a) 条 形 但 扫 朱 的 一 维 码 b) 扫 摘 后 显示 信息 
(4) 保存 物品 
a. 用 户 单 击 存储 物品 末 单 ， 物 品 保存 开始 ， 如 图 10-39a 所 示 。 
b. 单片机 收 到 命令 ， 开 始 取出 用 户 指定 的 箱子 ， 如 图 10-39b 所 示 。 
c. 箱子 取 到 后 ， 要 求 用 户 确 认 物 唱 已 经 放 入 箱子 ， 如 图 10-39c 所 示 。 
d. 用 户 确 认 物 品 已 经 入 箱 后 ， 程 序 癌 单 厂 机 友 运 命令 ， 将 箱子 放 回 柜子 的 原 位 置 ， 然 后 
返回 物品 存储 成 功 信 息 ， 并 将 物 唱 信息 写 入 数据 库 ， 如 图 10-39d 所 示 。 
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生起 : 
1 条 抽 条 品 - 
二 物品 信息 人 编 胃 物品 信息 
4 4 所 了 





图 10-39 ”物品 保存 
a) 物品 保存 开始 _b) 开始 取 箱 c) 用 户 确认 _d) 完成 取 箱 


2) 取出 物品 。 物 品 取 出 的 程序 如 图 10-40 所 示 。 








图 10-40 ”物品 取出 的 程序 框图 
用 户 可 以 在 首页 、 物 品 搜 索 页 面 、 提 醒 模 块 页 面 选择 物品 ， 然 后 选择 取出 操作 ， 进 行 物 
品 取出 。 图 10-41 为 用 户 选 择 取出 物品 的 操作 过 程 。 
Q 选择 取出 物品 。 
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书 取 出 物品 所 在 箱子 。 

(3) 要 求 用 户 确 认 物 品 已 经 取出 。 

网 成 功 取出 物品 。 

3) 物品 信息 编辑 。 同 取出 物品 一 样 , 在 省 页、 物品 搜索 页 面 、 物品 提醒 页 面 选择 相应 物品 ， 
选择 物品 信息 编辑 命令 ， 则 界面 目 动 转 问 物品 编辑 界面 ， 完 成 物品 信息 编辑 ， 如 图 10-42 所 示 。 





编辑 物品 信息 
| 取出 物品 


| 联网 搜索 物品 信息 





| A 
确认 物品 取出 + x “i l ! 
呈 | i ME 二 二 | 
。 是 否 已 经 将 物品 从 竹子 里 取出 ? | = 一 证， | 十 
, | ' pa -1 sa 二 EG TF 
汝 名胜 ' 户 | == _ 屁 旨 降生 恒 品 名 枉 howh 恒 晤 加 鲜 
和 各 生日 央 2014 生生 下 于 三 昌 是 20t204 EAD 在 硬 扫 轴 -2012-0 放 让 遇 入 午 卫 日 包 201204- 


站 碾 物 蔓 感 翅 醒 岗 | 








Cc) d) 


图 10-41 物品 取出 
a) 选择 取出 物品 b) 取出 箱子 c) 确认 物品 已 经 取出 d) 成 功 取出 物品 











图 10-42 ”编辑 物品 信息 
4) 技术 说 明 
Q) 条 形 但 生成 与 识别 技术 ， 用 于 扫描 、 生 成 与 物品 信息 相关 的 条 形 码 。 
@ 串口 通信 技术 ， 用 于 与 下 位 机 进行 串口 通信 ， 控 制 电动 机 取 送 物品 。 
(3) 安里 系统 开 友 技术 ， 实 现 人 简洁 美观 的 用 户 操 作 界 面 与 实用 的 物品 信息 管理 功能 。 
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(2) 物品 信息 搜索 模块 ”本 模块 主要 实现 物品 信息 的 本 地 搜索 与 联网 搜索 。 





1) 物品 信息 本 地 搜索 。 物 品 信息 本 地 搜索 主 界 面 如 图 10-43 所 示 。 


时 划 fil 四 10:42 










公共 用 户 
此 为 物品 信息 搜 a 让 家 更 简单 


索 框 ， 用 户 可 以 
在 此 输入 搜索 关 
键 子 ， 下 端的 搜 
索 结 果 列 表 会 实 
时 显示 搜索 结果 














此 为 物品 种 类 先 
择 柜 ， 用 户 可 以 
| A 在 此 选择 物品 种 
ME S 类 ， 搜 索 结果 将 
-Nl 7 可 0 随 着 物品 种 类 不 











此 为 搜索 结果 的 
列表 


图 10-43 ”物品 信息 本 地 搜索 主 界面 


2) 物品 信息 联网 搜索 。 用 户 可 以 选择 物品 条 目 ， 选 择 联 网 搜索 物品 信息 ， 以 获得 天 于 此 
物品 的 更 多 信息 。 

GD 先 选 择 联网 搜索 ， 如 网 10-44 所 示 。 

@ 用 户 可 以 选择 百度 、 谷 歌 、 淘 宝 、 京 东 、 晶 越 等 网 站 搜索 物品 信息 ， 如 图 10-45 所 示 。 











选择 搜索 网 站 


淘宝 网 





10-44 ”选择 联网 搜索 10-45 选择 搜索 网 站 
@) 搜索 结果 如 图 10-46 所 示 。 





x 淘宝 网 





= 四 搜 全 站 口 搜 天 猫 O 〇 搜 二 手 口 搜 全 球 购 
近 所 有 分 类 &ED - - 回 23 从 这 掌柜 热卖 
找到 相关 宝贝 2” 我 的 应 用 淘 足迹 分享 给 好 友 . 消息 购 “ 辆 热门 民生 食品 榜 “| 局 后 -| | 故 呈 天 


方便 面包 装 : 袋 装 。 杯 装 其它 
方便 面 (2271) 方便 速 食 (2271) 
“显示 全 部 分 


你 是 不 是 想 找 : ”康师傅 方便 面 批发 ， 康 师傅 方便 面包 邮 ， 康 师傅 方便 面 桶 装 





清真 食品 康 师 传 方 
便 面 有 20 包 面 18 个 
[ 





人 气 天 猫 二 手 ! 尼 用 搜索 定制 设置 1160 * 下 一 页 


关键 字 : | 康师傅 方便 面 排除 : 新 上 昌 "| | 交易 7 促销 商 - 


党 口 口 口 口 口 口 确定 最 近 成 交 26 笔 
默认 排序 ~ 销量 * 信用 * 价格 * 总 价 * -_ ”在 地 - 中 切换 到 大 图 


号 合并 同 款 宝 贝 过 合并 同 卖 家 宝贝 查看 0-12 元 的 宝贝 《56% 的 用 户 喜 欢 ) 上 


【上 海 专 享 】 康师傅 经 典 袋 f12.00 上 海 
红烧 凉 肉 方便 面 5 连 包 106*5 运费 : 5.00 


学 消费 者 


业 七 天 退 


最 近 成 交 2 





10-46 ”搜索 结 
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3) 技术 说 明 

GD 安 日 开发 技术 用 于 界面 设计 与 网 络 通 信 。 

GO 实时 搜索 算法 ， 用 于 对 数据 库 中 的 物品 信息 进行 实时 及 分 类 搜索 。 

(3) 物品 信息 提醒 模块 

1) 模块 功能 。 此 模块 主要 包含 两 大 功能 : 一 是 保质 期 提醒 ， 对 即将 过 期 的 物品 或 者 已 经 
过 期 的 物品 进行 提醒 ， 即 将 过 期 的 物品 的 提前 预警 时 间 由 用 户 目 己 设 定 ; 二 是 存储 超期 提醒 ， 
针对 超过 用 户 设 定 的 最 长 存储 时 间 的 物品 ， 对 用 户 进 行 预警 。 

2) 功能 展示 。 图 10-47 为 保质 期 提醒 。 存 储 超 期 提醒 类 似 于 保质 期 提醒 。 

3) 技术 说 明 。 使 用 安里 开发 技术 ， 进 行 界面 设计 与 数据 库 区 互 。 

(4) 用 户 信息 管理 模块 ”此 模块 主要 实现 用 户 注 册 、 登 陆 、 找 回 密码 、 修 改 密码 、 个 人 
言 尽 编 辑 等 功能 ， 通 过 此 模块 ， 用 户 可 以 注册 自己 的 账户 ， 将 目 己 的 隐私 物品 你 存在 私人 账 
户 ， 而 非 公 共 账 户 中 。 

1) 注册 功能 。 用 户 填 写 用 户 名 密码 及 安全 问题 ， 即 可 注册 新 的 用 户 ， 如 图 10-48 所 示 。 
































存储 超期 提醒 ”保质 期 提醒 

物品 匀称 : 

让 万 口 粉 些 

kh 拜 刁 日 期 : 

2012-04-10 8 时 da0 籽 

二 生产 日 期 : 2012.01201 

Be 保 硕 天 15 天 
= 物品 名 称 : 
A 娃哈哈 八 室 绪 
fs 存储 日 期 有 有 加 = 二 辣 二 3 
图 10-47 保质 期 提醒 图 10-48 ”新 用 户 注 册 


2) 登录 功能 。 用 户 登 录 个 人 账户 后 ， 即 可 查看 自己 的 私密 物品 ， 如 图 10-49 所 示 。 








3) 资料 编辑 。 用 户 可 以 在 此 处 编辑 个 人 信息 ， 如 图 10-50 所 示 。 





登陆 注册 必 基 同 呈 时时 忘记 空 码 修改 密码 


您 的 密码 





用 户 了 昵称 麻 相 行 
您 的 密码 
安全 问题 你 所 在 的 省 份 -| 
图 10-49 ”登录 个 人 账户 图 10-50 ”编辑 个 人 信息 





4) 找 回 密码 。 用 户 通 过 此 功能 ,验证 身份 后 ,可 以 重 旱 密码 或 进行 密码 修改 ,如 图 10-51 
所 未 。 
5) 技术 说 明 。 采 用 安里 开发 技术 ， 进 行 界面 设计 及 与 数据 库 的 交互 。 
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登陆 注册 ” 资料 编辑 礼 记 密 码 修改 密码 | 
用 户 昵 称 


安全 问题 你 最 夏 欢 的 水 果 理 


问题 答案 


图 10-51 重 置 密码 


(5) 用 户 帮 助 模块 ”通过 此 模块 ， 用 户 可 以 设 定 其 存储 的 物品 的 最 长 存储 时 间 及 保质 期 
提前 预警 的 天 数 ， 此 外 用 户 可 以 在 此 模块 查看 用 户 帮 助 及 软件 相关 信息 。 

1) 软件 可 进行 保质 期 与 存储 期 的 设置 ， 如 图 10-52 所 示 。 

2) 用 户 帮 助 。 图 10-53 为 用 户 帮 助 界面 。 








只 | 秆 3:37 


| 用 户 帮助 关于 用 户 设置 计时 所 EW 擅 于 x 


此 程序 为 智能 家 居 控 制 端 ， 通过 此 客户 端 ,用户 可 以 宽 现 物品 信息 的 千 能 蚁 - 





和 10 天 | 入 ,物品 信息 的 本 地 查询 与 联网 得 询 , 物 岛 存储 时 间 及 保质 期 的 及 时 提醒 , 不 
| Cg 同 家 许 成 员 之 间 的 隐私 保护 
物品 20 支 本 
器 长 存 晴 时 间 一 
设置 
图 10-52 ”保质 期 与 存储 期 的 设置 图 10-53 用户 帮助 界面 


3) 关于 软件 。 介 绍 本 软件 的 名 称 、 开 发 者 及 版 本 信息 。 

4) 技术 说 明 。 采 用 安里 开发 技术 ， 进 行 界 面 设计 及 与 数据 库 的 交互 。 

5. 软件 特色 

(1) 界面 简洁 美观 ”软件 界面 凸显 傈 洁 天 观 的 原则 ， 主 色调 站 合 家 庭 的 温 志 有 氛围， 多 数 
功能 单 击 一 个 按钮 就 能 实现 跳 转 ， 何 化 了 用 户 操 作 ， 减 少 界面 跳 转 时 用 户 每 每 的 时 间 。 

(2) 你 护 用 户 隐 私 ， 家庭 成 员 只 有 登录 账户 后 才能 进行 物品 的 存 取 及 信息 管理 ， 账 户 分 
为 两 种 ， 一 种 为 公共 账户 ， 一 种 为 用 户 目 己 注册 的 个 人 账户 。 

对 于 公共 账户 ， 任 何 家 庭 成 员 缘 可 登录 ， 用 于 存储 管理 一 些 家 庭 中 的 公共 用 品 。 对 于 个 
人 账户， 其 存储 或 取出 的 物品 其 他 用 户 无 法 丛 看 ， 所 以 适合 管理 不 同 家 庭 成 员 的 私人 物品 。 

(3) 物品 联网 搜索 

1) 物品 信息 联网 搜索 功能 。 系 统 提供 对 价格 、 使 用 方法 等 搜索 功能 ， 文 持 主 流 的 搜索 引 
向 (百度 与 Google) 及 主流 的 购物 搜索 引擎 “如 亚 马 进 、 淘 宝 、 当 当 、 京 东 )。 

2) 物品 信息 一 维 条 形 人 码 搜索 。 为 方便 用 户 在 存储 物品 的 时 候 输 入 物品 信息 ， 系 统 会 根据 
用 户 输 入 的 一 维 条 形 码 ， 联 网 搜索 物品 的 相关 信息 ， 并 摘 取 其 中 有 用 的 部 分 ， 目 动 填 入 物品 
信息 表单 。 

(4) 信息 格式 实用 ”通过 物品 名 称 及 图 像 ， 用 户 可 以 方便 快捷 地 对 该 物品 进行 搜索 与 全 
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询 ， 可 以 随时 修改 物品 的 相关 信息 。 物 品 信息 的 格式 如 下 : 

(5) 录入 方式 多 样 ” 在 录入 物品 信息 时 ， 软 件 提供 多 种 信息 录入 方式 : 

1) 手动 输入 。 

2) 扫描 二 维 条 形 码 。 

3) 扫描 一 维 条 形 码 ， 联 网 查询 物品 信息 。 

4) 手动 输入 一 维 条 形 码 ， 联 网 查询 物品 信息 。 

5) 启动 系统 拍照 程序 ， 拍 摄 物品 照片 。 

除 手动 输入 的 其 他 方式 都 可 以 快速 获得 物品 大 量 信 息 ， 自 动 填写 物品 信息 表单 ， 减 少 用 
户 在 信息 输入 上 的 耗 时 ， 使 物品 存储 简单 高 效 。 

(6) 提醒 服务 便捷 ”为 方便 用 户 能 够 及 时 对 将 要 过 期 或 者 不 能 存储 太 久 的 物品 进行 处 理 ， 
系统 提供 存储 超期 物品 提醒 服务 及 即将 过 期 物品 提醒 服务 。 

1) 超期 物品 提醒 服务 。 用 户 可 以 设 定 物品 的 最 长 存储 时 间 ， 比 如 对 于 衣服 ， 议 定 其 最 长 
存储 30 天 ， 存 储 之 日 的 30 天后， 系统 会 提醒 用 户 此 物品 应 该 取出 。 

2) 保质 期 提前 提醒 。 例 如 用 户 可 以 设 定 物品 你 质 期 提前 提醒 的 时 间 为 10 天 ， 那 么 从 物 
品 保质 期 截止 日 期 的 10 天 前 ， 系 统 都 会 提醒 用 户 处 理 即 将 过 期 的 食品 或 已 经 过 期 的 食品 。 

(7) 开发 运行 环境 

1) 操作 系统 : Android 2.33。 

2) 便 件 系统 : Tiny6410 开发 板 + 智 能 手机 + 平板 电脑 。 

3) 数据 库 : SQlite3。 

4) 开发 语言 : Java。 

5) 开发 环境 : Eclipse3.7+Android 模拟 器 +Win7 操作 系统 。 


I 主要 创新 点 及 取得 的 成 果 












































10.4.1 作品 主要 创新 点 


本 作品 融合 了 机 电 、 通 信 、 物 联网 、 信 息 检索 、 软 件 等 多 种 技术 ， 是 一 种 能 够 满足 现代 
人 们 追求 高 品位 生活 需求 的 新 产品 ， 填 补 了 我 国 智能 家 居 产品 的 市 场 空白 。 主 要 特色 与 创新 
点 有 : 

(1) 作品 实用 性 强 “ 结 合 当下 房价 居 高 不 下 的 现实 ， 并 针对 家 庭 衣物 、 杂 物 的 储藏 空间 
利用 率 不 足 的 现状 ， 通 过 机 电 一 体 化 的 手段 ， 实 现 了 对 高 层 空间 的 充分 利用 ， 由 于 采用 全 自 
动 的 方式 ， 避 免 了 用 户 取 放 高 处 物品 的 危险 ， 可 给 家 居 生 活 带 来 更 舒适 的 体验 。 

(2) 提升 家 居 生 活 质 量 所 储存 的 物品 全 部 采用 扫描 编码 技术 ， 用 户 可 以 通过 管理 平台 
随时 了 解 物 品 的 存放 时 间 、 具 体位 置 等 重要 存 取信 息 。 在 需要 物品 时 通过 操作 管理 平台 ， 输 
入 关键 词 或 相关 信息 ， 实 现 自动 定位 拿 取 、 装 置 归 位 的 功能 ， 免 去 用 户 寻找 之 劳 ， 为 当今 人 
们 的 快 节奏 生活 提供 便利 。 

(3) 实现 智能 化 管理 ”运用 最 新 技术 与 网 络 资源 结合 ， 在 管理 系统 配置 中 ， 利 用 安 卓 系 
统 开发 平台 ， 实 现 自动 上 网 搜索 ， 下 载 物品 相关 信息 ， 在 对 物品 实现 分 类 储存 的 同时 完善 物 
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口 信息， 并且 可 以 手机 操作 ， 方 便 用 户 随时 了 解 物品 情况 。 针 对 不 同 物品 的 使 用 属性 ， 进 行 
针对 性 平台 服务 ， 如 在 食物 保质 期 临近 时 提醒 用 户 及 时 食用 ， 在 衣服 储存 周期 临近 时 提醒 用 
户 定 期 取出 上 明 郴 等 。 以 友好 的 用 户 界 面 方式 和 安全 可 徘 的 目 动 操作 ， 实 现 家 居 物 品 的 标准 化 、 
信息 化 、 智 能 化 分 类 与 管理 。 

(4) 性 价 比 高 ， 适 用 性 强 ”作品 研发 充分 利用 现 有 平台 资源 ， 降 低 成 本 ,扩充 信息 ， 是 
装置 易于 根据 不 同 的 家 庭 空间 条 件 进行 订 制 ， 为 作品 市 场 化 提供 了 重要 的 保证 。 





























10.4.2 ”作品 取得 的 成 果 


作品 取得 的 成 果 如 下 : 

1) 高 处 空间 物品 存放 及 管理 系统 原理 样机 1 台 。 

2) 高 处 空间 物品 存放 及 管理 系统 研究 技术 报告 1 份 。 

3) 申请 国家 发 明 专 利 1 项 : 室内 高 处 空间 物品 存放 及 管理 系统 。 
4) 获得 首都 高 校 第 六 届 机 械 创 新 设计 大 赛 一 等 奖 。 


忆 结 与 展望 


10.5.1 作品 研发 工作 总 结 


为 解决 宇内 品 处 空间 利用 京 低 、 储 物 效率 低 等 问题 ， 绥 解 人 、 物 品 、 住 房 空 间 之 间 的 矛 
盾 ， 项 目 组 成 功 研发 了 室内 局 处 空间 物品 存放 及 浓 理 系统 。 用 户 遂 过 触摸 屏 发 出 存 取 指 令 ， 
提升 猴 置 可 升降 储 物 盒 ， 储 物 单 元 取 放 装置 可 将 储 物 盒 放 置 于 悬挂 人 杂 上 ， 或 从 巧 挂 货架 上 
取出 储 物 盒 ， 在 水 平 拖 动 北 置 的 带动 下 与 托盘 实现 储 物 例 的 交换 。 访 作品 成 本 适中 、 目 动 化 
程度 局 、 贴 近 生活 、 经 济 实 用 、 人 机 交互 、 智 能 管理 ， 可 有 效 提 高 储 物 效 率 和 衬 间 利用 座 ， 
达到 省 事 和 省 力 的 效果 ， 是 一 个 具有 较 强 市 场 苋 搜 力 的 产品 ， 其 有 较 好 的 社会 和 经 济 效 益 。 

尽管 团队 成 员 投 入 了 大 量 的 时 间 和 精力 对 该 作品 进行 设计 与 研发 ， 并 成 功 制作 出 实物 
样机 ， 但 由 于 受 技术 水 平 及 研究 经 费 的 限制 ， 该 作品 疝 有 许多 不 足 忆 处 ， 主 要 包括 以 下 几 
个 方面 : 

1) 整 僚 系 统 重 量 较 和 大， 运输 、 安 疙 人 不便。 

2) 取 放 储 物 蛙 元 的 定位 精度 不 融 。 

3) 站 置 目前 为 原理 样机 ， 且 储 物 单 元 取 放 北 罩 可 背 动 ， 所 以 许多 控制 线 保 圳 在外， 影响 





















































如 果 本 产品 投放 市 场 或 者 进行 进一步 研究 时 ， 可 从 以 下 几 个 方面 进行 改进 : 
1) 在 保证 机 械 强度 的 同时 ， 减 轻重 量 。 

2) 使 用 精度 与 灵敏 上 度 更 融 的 位 置 传 感 占 ， 近 升 限 位 精度 。 

3) 优化 整套 系 统 布线 ， 增 强 美 观 性 。 








10.5.2 ”作品 应 用 范围 及 前 景 分 析 


成 东 为 市 场所 用 ， 转 化 为 生产 力 ， 才 能 成 为 好 产品 。 ”高 处 空间 物品 存放 及 管理 系统 ”是 
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基于 智能 化 泄 理 平 台 开 屎 的 家 居 新 产品， 适应 了 社会 发 展 和 人 们 需求 ， 极 具 苋 争 力 ， 市 场 应 
用 前 景 广 阅 ， 有 原因 如 下 : 

1) 本 产品 的 成 功 研 制 解决 了 蜗 处 物品 难以 取 放 的 难题 ， 方 便 各 类 人 群 特别 是 老 弱 人 员 存 
取 物 品 的 需要 ， 省 心 省 力 的 同时 增强 了 物品 存 取 的 便利 性 、 安 全 性 和 美观 性 。 

2) 本 产品 拥有 自主 研发 的 软件 管 理 系统 ， 人 机 交互 界面 友好 ， 用 户 可 利用 该 系统 对 物品 
进行 记录 、 检 索 、 分 类 、 奏 阅 许 细 信 息 等 操作 ， 极 大 地 提升 了 居民 的 生活 质量 。 

3) 本 产品 结构 简单 ， 占 地 面积 小 ， 可 充分 利用 室内 局 处 空间 ， 提 高 了 储 物 效率 ， 有 效 改 
善 家 居 生 活 条 件 。 

4) 本 产品 拓展 性 好 ， 当 机 构 进 一 步 扩 大 ， 控 制 性 能 进一步 增强 后 ， 可 用 作 和 集装箱 的 自动 
取 放 装置 或 是 一 种 立体 仓库 ， 具 有 巨 大 的 潜在 市 场 价值 。 
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第 11 章 壁面 清洁 智能 机 器 人 
(首都 高 校 第 去 届 机 械 创 新 设计 大 赛 一 等 奖 ，2012 年 ) 


5 作品 研究 的 背景 及 意义 


玻璃 幕 增 凭 倍 其 消 独 的 特点 ， 并 且 上 其 有 防 献 、 防 明 、 防 品 声 等 优点 ， 而 且 可 以 经 过 特殊 
的 加 工 过 程 得 到 各 种 各 样 的 形式 ， 因 此 近年 来 得 到 了 建筑 师 的 育 睐 。 然 而 ， 玻 璃 壁面 的 清洁 
工作 也 成 为 家 尾 生 活 或 公共 场所 的 一 大 难题 。 室 外 玻璃 窗 面 的 污染 主要 来 日 于 空气 中 的 粉尘 、 
灰 生 以 及 雨水 沉积 的 污 省 等 ， 长 期 的 窗 面 污染 使 玻璃 莫 增 的 美观 上 度 越 来 越 低 ， 更 重要 的 是 透 
明度 的 削弱 使 玻璃 帮 增 的 功用 大 幅 较 小 。 

很 多 大 中 城市 都 有 明确 规定 ， 这 种 局 层 建筑 需要 定期 进行 清理 。 然 而 由 于 目前 并 没有 能 
够 很 好 适应 现状 的 盛 面 清洗 机 右 人 ， 以 全 于 所 有 的 清洗 几乎 都 是 由 人 工 采 用 吊 绵 的 方式 手工 
进行 的 ， 如 图 11-1 所 示 。 和 面 对 这 样 的 高 术 大 厦 ， 人 工 清洗 不 仅 在 效率 上 得 不 到 很 好 的 保证 ， 
而 且 高 空 吊 缆 很 容易 造成 人 员 伤亡 事故 。 
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图 11-1 传统 壁面 清洁 模式 
以 此 为 背景 ， 研 究 人 员 提 出 了 多 种 有 关 壁 面 清洗 机 堪 人 的 方案 ， 但 仍 存在 看 一 定 的 局 限 
性 。 如 磁力 吸盘 爬 壁 机 堪 人 ， 它 只 能 用 于 导 做 金属 壁面 ， 而 对 普通 玻璃 增 壁 却 无 法 适用 ， 许 
多 大 型 上 基 挂 清洗 机 右 人 要 求 有 楼 顶 蕉 挂机 构 ， 矶 绕 式 的 高 空 玻璃 清洁 机 器 人 虽然 可 以 代 蔡 人 
工 ， 减 少 伤亡 事故 的 发 生 率 ， 提 高 清洁 效率 ， 但 是 这 类 清洁 机 器 人 无 法 摆脱 吊 顷 的 控制 ， 不 
共有 智能 识 询 和 请 洗 的 功能 ， 为 其 普及 应 用 市 来 了 困难 。 
为 使 壁面 清洁 机 器 人 能 够 具有 更 好 的 适应 能 力 和 清洁 能 力 ， 项 目 组 设计 和 开发 了 一 种 履 
剖 吸 盘 陈 壁面 清洁 智能 机 器 人 。 此 机 堪 人 可 以 摆脱 吊 顷 的 束缚 ， 即 采用 无 顷 式 控制 ， 而 且 具 
有 一 定 的 越 障 和 目 动 识别 功能 ， 能 在 低 功 耗 的 情况 下 ， 守 成 需要 的 工作 量 。 另 外 ， 相 比 于 四 
足 式 爬 壁 机 器 人 ， 如 网 11-2 所 示 ， 上 共有 更 好 的 工作 平稳 性 和 安全 性 。 访 作品 的 研究 对 于 提 融 
情 面 清洗 效率 、 减 少 人 员 伤亡 、 扩 大 清洗 范围 、 提 高 壁面 清洁 机 吉 人 的 智能 化 水 平 具 有 重要 
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意义 。 此 外 ， 履 市 吸 副 式 壁 面 吸附 平台 还 可 推广 应 用 于 消防 探测 、 油 馈 检 测 、 违 路 除 冰 及 南 
极 科 考 等 工作 。 





图 11-2 ”四 足 仆 壁 机 器 人 
作品 概述 
11.2.1 研究 内 容 概述 


壁面 清 活 智能 机 器 人 是 根据 第 五 届 (2012 年 ) 全 国 大 学 生机 械 创 新 设计 大 赛 “ 竺 福生 
活 一 一 今天 和 明天 ”的 主题 及 “休闲 娱乐 机 械 和 家 许 用 机 械 的 设计 和 制作 ”的 内 容 而 “ 量 喘 定 
制 ” 的 ， 属 于 “家 峰 清 洁 用 机 械 ”。 该 机 副 人 可 实现 在 玻璃 匡 墙 、 癣 砖 外 增 等 焉 下 表面 上 行进 
并 进行 清洗 工作 ， 整 机 主要 包括 机 械 结构 部 分 和 控制 系统 部 分 。 

机 械 结 构 部 分 由 履 冲 式 行 进 机 构 、 真 空 吸盘 陈 吸附 机 构 、 转 问 机 构 及 清洲 装置 等 组 
成 。 机 需 人 依靠 朔 有 吸盘 的 履 市 行进 ， 履 带 吸 盘 与 真空 友 连接， 吸盘 采用 经 特殊 设计 的 
目 珊 气 浆 陈 结构 ， 可 通过 相应 的 凸轮 配 气 机 构 配 气 、 枉 杆 机 构 放 气 ; 撒 盘 中 部 设 有 转 问 
吸盘 ， 通 过 电动 机 控制 滚珠 丝 杠 的 运转 ， 可 使 车 体 围 丝 转 同 吸盘 轴线 旋转 ， 实 现 转 辣 ; 
车 体 前 病 设 有 超声 探测 与 反馈 准 置 ， 可 保证 机 费 人 在 行进 中 能 实时 测 障 与 避 障 ;车 体 上 
装 有 筋 状 顺 淋 朔 置 、 六 简 刷洗 竣 置 和 刮 板 刮 洗 装 置 等 清洁 猴 置 ， 能 够 在 机 闫 人 行进 时 进 
行 墙 面 的 清洗 工作 。 

控制 系统 部 分 采用 上 下 位 机 的 分 层 控制 模式 。 采 用 PC 机 作为 上 位 机 对 机 器 人 进行 远 距 离 
监控 ， 通 过 无 线 串 口 将 控制 指令 友 送 给 下 位 机 。 下 位 机 米 用 80C52 单片机 ， 电 动机 的 驱动 采 
用 驱动 蕊 片 驱 动 和 继 电 咒 驱动 相 结 合 的 方式 。 通 过 该 控制 系统 实现 壁面 清洁 稼 能 机 占 人 的 巡 
回路 径 规 划 、 行 进 速度 控制 、 监 控 测 障 处 理 及 转 癌 电动 机 控制 等 。 


11.2.2 ”技术 指标 
作品 技术 指标 如 下 : 


1) 长 三 495mm， 宽 三 280mm， 高 和 220mm， 自 重 志 10kg。 

2) 平均 行进 速度 为 4.8m/min， 最 高 巡航 速度 为 6m/min。 

3) 可 完成 玻璃 闫 才 的 请 扫 工 作 ， 并 可 针对 不 同 任务 需求 更 改 搭 载 功能 模块 ， 完 成 多 种 次 
型 的 作业 任务 。 

4) 持续 无 障 但 作业 时 间 不 小 于 150min。 
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11.3.1 机 器 人 结构 设计 


1， 机 器 人 功能 分 析 

本 作品 是 针对 于 能 在 玻璃 幕墙 、 瓷 夸 等 光滑 壁面 上 利用 履带 式 吸盘 行进 及 利用 清洗 平 
台 进 行 壁面 清洗 的 壁面 清洁 智能 机 器 人 。 机 器 人 在 行进 过 程 中 ， 吸 附 系统 可 以 保证 机 器 人 紧 
贴 壁面 而 不 会 出 现 打 滑 和 脱落 的 现象 ， 同 时 行进 机 构 可 以 保证 机 器 人 平稳 地 在 壁面 上 移动 ， 
清洁 系统 在 机 器 人 行进 的 过 程 中 对 壁面 完成 清洗 。 机 器 人 还 能 自动 识别 障碍 及 玻璃 幕墙 的 边 
缘 ， 在 遇 到 无 法 跨越 的 障碍 或 作业 到 幕墙 边缘 时 ， 转 向 系统 开始 工作 ， 使 机 器 人 转向 ， 并 完 
成 较 大 范围 的 幕墙 清洗 工作 。 

壁面 清洁 智能 机 器 人 若 要 完成 以 上 各 项 预定 任务 ， 必 须 具 有 以 下 几 项 能 

1) 吸附 能 力 : 机 器 人 真空 吸盘 与 壁面 所 产生 的 摩擦 力 必须 大 于 自身 的 重力 ， 保 证 机 器 人 
安全 地 吸附 在 壁面 上 ， 不 会 出 现 打滑 和 脱落 现象 。 

2) 行进 能 力 ， 机 器 人 需 有 行进 机 构 ， 使 机 器 人 能 自由 地 行走 。 

3) 识别 能 力 ， 机 器 人 在 幕墙 上 自由 行走 时 ， 需 要 智能 识别 幕墙 的 边缘 及 无 法 跨越 的 高 隧 
得 物 。 

4) 转向 能 力 ， 在 遇 到 无 法 跨越 的 高 障碍 物 和 到 达 幕墙 的 边缘 时 ， 机 器 人 能 在 智能 识别 之 
后 通过 转向 系统 进行 转向 ， 不 仅 能 提高 机 器 人 的 安全 性 能 ， 也 能 提高 机 器 人 在 整个 壁面 上 的 
清洁 效率 。 

5) 工作 环境 适应 能 力 : 机 器 人 所 在 的 工作 壁面 并 不 是 完美 理想 的 光滑 壁面 ， 当 工作 
面 上 有 凸 起 和 沟 槽 时 ， 机 器 人 要 通过 这 些 障 碍 物 ， 就 必须 有 足够 的 越 障 能 力 。 由 于 疏 壁 机 
器 人 工作 壁面 的 特殊 性 ， 移 动机 构 常 和 吸附 机 构 存 在 耦合 ， 这 给 机 器 人 的 运动 控制 带 来 了 
一 些 困难 。 

2， 机 器 人 整体 结构 

壁面 清洁 智能 机 器 人 的 整体 设计 框图 如 图 11-3 所 示 。 该 机 器 人 的 整体 结构 主要 包括 以 下 
几 个 方面 ; 

1) 吸附 结构 ， 保 证 壁面 清 ; 

2) 行进 机 构 ， 保 证 壁面 清 ; 

3) 转向 机 构 : 保证 壁面 清 ; 

4) 识别 装置 ;辅助 壁面 清 
碍 ， 进 而 通过 转向 机 构 进行 转向 。 

5) 清洁 机 构 : 保证 壁面 清洁 智能 机 器 人 能 完成 清洗 壁面 的 工作 。 

3， 机 器 人 的 吸附 机 构 

(1) 吸盘 的 结构 与 设计 真空 吸盘 结构 的 原理 图 和 示意 图 分 别 如 图 11-4 和 图 11-5 所 示 ， 
它 在 履带 上 的 安装 位 置 如 图 11-6 所 示 。 吸 盘 的 顶部 为 橡胶 制 成 的 碗 状 结构 ， 当 吸盘 行进 到 前 
轮 时 ， 真 空 泵 的 气 嘴 插 入 其 中 并 吸 气 ， 吸 盘 的 气管 里 面 由 橡胶 密封 球 、 弹 簧 组 成 ， 吸 气 形成 
负 压 之 后 ， 吸 盘 顶 部 气孔 直接 和 大 气压 接触 ， 大 气压 对 密封 球形 成 压力 ， 从 而 阻止 气体 进入 


© 


















































IT 


儿 器 人 在 壁面 上 行进 时 不 会 出 现 打 请 和 脐 落 。 

儿 大 人 在 壁面 上 可 以 目 由 行进 。 

儿 颖 人 作业 到 一 定 情形 时 能 够 转 问 绕 行 。 

机 左 人 在 壁面 行进 作业 时 智能 识别 机 左 人 无 法 区 服 的 障 
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真空 豚 失 中 ， 你 证 吸盘 的 真空 有 度 。 吸 盘 外 部 有 杠杆 站 萤 ， 当 吸盘 行进 到 后 轮 时 ， 利 用 后 轮 车 
架 上 设计 的 凸 起 状 置 带动 杠杆 工作 ， 杠 杆 拉 出 密封 阀 ， 空 气 进入 吸盘 ， 使 吸盘 不 再 保持 真空 ， 
完成 吸盘 与 壁面 的 脱离 。 








红外 传 感 装 置 


行车 控制 与 吸附 系统 





转 问 吸盘 子 系统 






深 休 刷洗 
装置 













图 11-5 真空 吸 税 示 意图 图 11-6 吸盘 在 履带 上 的 安 沪 位 置 
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(2) 吸附 机 构 安 全 性 论证 ”为 了 确定 盛 面 清洲 智能 机 器 人 的 负载 能 力 和 安全 性 能 ， 对 其 
进行 受 力 分 析 。 当 机 器 人 吸附 在 玻璃 壁面 上 时 ， 受 力 情 况 如 网 11-7 所 示 。 
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图 11-7 机 费 人 吸附 受 力 情况 


岁 了 < 日 伍 仁 二 的 是 多 则 下 

1) NN; 一 一 增 壁 对 第 i 组 吸盘 的 法 向 文 撑 力 (和 垩 直 于 增 和 而)，i=1…,5 。 

2) 一 一 作用 在 第 i 组 吸盘 上 的 真空 吸力 。 

3) 一 一 增 壁 作用 在 第 i 个 级 失 上 的 摩擦 力 。 

4) G 一 一 机 规 人 的 重力 《包括 外 议 )。 

5) 了 一 一 相 邻 两 组 吸 检 之 间 的 距离 。 

6) 4 一 一 机 器 人 的 等 效 重 心 到 玻璃 壁面 的 距离 。 

当 硼 面 清洁 智能 机 右 人 在 玻璃 壁面 上 移动 时 ， 有 两 种 危险 的 情况 可 能 发 生 : 一 种 情况 是 
它 从 墙 徊 上 滑落 ;为 一 种 情况 是 最 上 方 接触 的 吸盘 由 于 受到 的 倾 翻 力 窍 太 大 脱离 墙 甸 ， 引 起 
机 器 人 倾 翻 。 设 计 吸 附 机构 时 ， 应 避免 滑落 和 倾 翻 这 两 种 情况 有 发生。 为 了 条 化 分 析 ， 考 夸 钥 
态 吸 附 情况 。 

1) 避免 机 器 人 从 寺 面 上 请 落 。 根 据 摩 欣 力 的 特性 ， 最 大 静 摩 欣 力 要 大 于 滑动 摩 控 力 ， 有 




















9 
G<minCfy, fy)=2U2N, (11-1) 


i=] 














2) 避 多 机 各 人 从 玻璃 幕墙 上 倾 翻 。 假 设 作用 在 文 撑 轮 上 的 力 不 巴 考虑， 认为 墙壁 对 机 可 
人 的 反作用 力 只 作用 在 与 增 壁 接触 的 吸盘 上 ， 则 静态 情况 下 ， 机 器 人 在 水 平和 垂直 方 癌 上 的 
受 力 分 别 症 足 








> (CN -WD)=0 (11-2) 
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5S 
G-> 三 =0 (11-3) 
i=] 
所 受 的 平衡 力 窍 为 (以 机 器 人 的 重心 为 参照 点 ) 
S 
>》CN -VXi-D p=Gd (11-4) 


i=] 








假定 各 个 吸盘 的 真空 度 是 均衡 的 ， 则 作用 在 吸盘 上 的 吸力 为 


V=sAp (11-5) 
为 了 方便 计算 作用 于 吸盘 上 的 支撑 力 N，(i=1,…,5 )， 假 设 从 WW 到 WN, 比例 增加 ， 即 
Np ™— Vn dV (i=1,2,3) (11-6) 
将 式 (11-2)、 式 (11-4)、 式 (11-6) 联 立 ， 可 得 
-tio (11-7) 
| l0p 10p 
理论 上 只 要 满足 >0， 则 条 件 2) 满足 。 由 式 (11-7〉 及 N >0， 可 求 得 
Vp 
Ge _ 
< (11-8) 


4. 机 器 人 的 行进 机 构 

(1) 履 市 的 结构 与 设计 壁面 清洁 稼 能 机 各 人 的 行 
走 机 构 主要 由 吸盘 组 件 、 履 带 、 履 市 轮 、 动 力 源 、 传 动 
系统 、 控 制 系统 等 构成 。 其 中 履带 后 轮 为 主动 轮 ， 前 部 
分 由 前 轮 和 同步 轮 组 成 。 所 设计 的 履带 结构 如 图 11-8 所 
示 。 采 用 标准 345H 69 闪 形 同步 之 ,履带 的 前 部 分 为 斜 
面 ， 这 样 可 以 防止 履带 在 行进 过 程 中 吸盘 与 壁面 出 现 干 























涉 导 致 吸盘 雪 折 而 无 法 吸附 。 图 11-8 ”加 工 后 的 标准 345H 69 具 形 
为 满足 传动 天 系 和 同步 市 的 唉 合 关 系 ， 需 要 对 机 同步 带 








器 人 的 总 体 布 置 设 计 相 关 尺 寸 ， 并 以 此 为 基础 设计 底盘 尺寸 。 履 带 定 型 下 的 轴 件 尺寸 如 图 
11-9 所 示 。 








图 11-9 ”履带 定型 下 的 轴 件 尺寸 


(2) 避 面 清洁 智能 机 大 人 行进 能 力 论 证 ”履带 轮 张 动 履 市 转动 时 ， 根 据 功 率 的 关系 可 得 
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已 =MwO= kmev (11-9) 
式 中 了 一 一 驱动 轮 传递 给 履带 的 功 京 (W); 
4 .一 一 主动 轮 驱 动 履 带 的 扭矩 〈N-my); 
20 一 一 主动 轮转 动 的 角速度 (rad/s); 
大 一 一 安全 系数 ， 是 为 了 保证 有 一 定 的 功率 损耗 ， 一 般 取 2 一 3; 
7 一 一 机 器 人 在 壁面 上 的 行进 速度 (my/s )。 
设 在 主动 轮 工 作 中 一 个 齿 上 的 檀 切 力 为 ， 则 有 
F =Ar=bIr (11-10) 
式 中 “4 一 主动 轮 齿 底部 的 截面 积 (mm); 
7 一 一 主动 轮 轮 齿 瓜 部 受到 的 切 应 力 (Pa); 
一 一 主动 轮 轮 齿 瓜 部 截面 的 长 上 度 (mm); 
/一 一 主动 轮 轮 齿 底 部 截面 的 宽度 (my); 
对 主动 轮 中 心 取 和 矩 ， 由 平衡 方程 > Mu =0 ， 可 得 
iFr=ibltrr=M, (11-11) 
式 中 《一 一 主动 轮 的 半径 (mm ); 
盖 -一 处 于 工作 状态 的 齿 数 。 
对 于 主动 轮 的 转动 有 
VvV= Or (11-12) 
联 立 式 (11-9)、 式 (11-11)〉 和 式 (11-12〉 可 得 主动 轮 轮 齿 底 部 受到 的 切 应 力 z 为 
_ hmg _ 
区 三 (11-13) 


S， 机 器 人 的 吸附 系统 

(1) 履带 与 吸盘 的 连接 履带、 同步 带 轮 、 吸 盘 的 疙 配 关 系 如 图 11-10 所 示 。 为 了 避 钢 
在 履带 旋转 时 吸盘 管 与 履 市 轮 发 生 干 涉 ， 在 履带 轮 的 中 间 设 计 有 一 定 深度 和 宽度 的 沟 槽 ， 使 
机 右 人 在 行进 时 吸盘 能 够 平顺 地 在 履 融 上 运转 ， 并 能 成 功 地 吸 气 与 放 气 。 履 珊 和 吸盘 之 间 甩 
用 压 蔷 进行 柔性 连接 ， 以 保证 配 气 机 构 功 能 实现 时 的 平顺 性 与 可 徘 性 。 

















图 11-10 履带、 同步 带 轮 、 吸 盘 的 猜 配 关 系 
(2) 吸附 系统 的 工作 过 程 ” 配 气 闭 置 采 用 凸轮 结构 ， 真 空 和 与 履带 轮 的 前 轮 形 成 配合 ， 
吸 气 装置 配置 在 前 轮 。 履 市 轮 的 后 轮 为 驱动 轮 ， 放 和 气 装 置 配 置 在 后 轮 车 架 上 。 当 张 动 轮转 动 
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时 ， 履 市 通过 和 履 帝 轮 的 哮 合 作用 运转 ， 同 时 履带 上 面 的 吸盘 伴随 看 履带 运动 。 网 11-11 所 示 
的 次 轮机 构 ， 能 满足 一 定 的 传动 比 关 系 ， 当 每 个 吸盘 转动 到 气 踪 下 ， 贞 轮机 构 可 以 你 证 凸轮 
行径 的 最 高 点 刚好 能 推动 气 嘴 癌 下 运动 ， 从 而 使 气 跨 与 吸盘 吸 气 口 连接 ， 借 助 真 空 采 完成 吸 
气 。 妆 吸盘 在 履 沉 的 带动 下 转动 到 后 轮 时 ， 和 车 架 上 的 凸 起 状 症 利用 杠杆 的 作用 将 吸盘 的 部 的 
密封 气 阀 打开 ， 使 真空 吸 熏 与 大 气 之 间 贯 通 ， 从 而 使 空气 进入 吸盘 中 ， 完 成 “ 放 气 ”的 过 程 ， 
使 吸盘 不 再 有 真空 有 度 ， 与 壁面 脱离 。 吸 盘 在 履带 上 的 如 此 往复 作业 ， 保 证 了 机 各 人 的 吸附 和 
行进 。 





























图 11-11 真空 人 汞 与 前 轮 形成 配合 的 齿轮 和 凸轮 机 构 


6. 机 器 人 的 转向 系统 

(1) 转向 系统 的 结构 与 设计 “车 体 的 转向 系统 主要 由 中 央 大 吸盘 、 丝 枉 、 齿 轮 及 蜗轮 蜗 
杆 电动 机 等 组 成 。 由 于 中 央 大 吸盘 在 整个 转 问 过 程 中 起 看 至 关 重 要 的 作用 ， 在 这 里 主要 介绍 
中 央 大 吸盘 的 结构 及 大 吸盘 在 车 体 转 癌 时 的 整个 作业 过 程 。 

中 央 大 吸盘 的 模型 与 装配 图 如 图 11-12 所 示 ， 其 主要 结构 与 位 于 履带 上 面 吸 盘 的 续 
构 基 本 相同 。 吸 气管 设计 在 吸盘 的 侧面 ， 而 吸盘 顶部 则 与 车 体 底 盘 上 面 的 丝 枉 、 螺 母 等 
装置 连接 。 中 央 大 吸盘 与 履带 吸盘 在 吸 气 过 程 中 采用 同一 个 真空 条， 但 是 采用 不 同 的 气 
动 回路 。 

中 央 大 吸盘 的 电动 机 采用 蜗轮 蜗杆 式 传动 装置 ， 能 够 提供 强大 的 扭矩 ， 并 具有 上 自 锁 的 性 
质 ， 能 够 保证 吸盘 在 完成 转 癌 、 电 动机 停止 工作 后 不 会 因 重 力 算 作用 而 出 现 翻 转 或 摆动 等 情 
况 。 转 癌 装 置 与 电动 机 的 装配 关系 如 图 11-13 所 示 。 
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图 11-12 车 体 撒 盘 中 央 大 吸盘 的 模型 与 装配 图 图 11-13 ” 转 回 闭 置 与 电动 机 的 猴 配 关系 图 
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(2) 转 癌 系统 的 工作 过 程 ”壁面 清洁 智能 机 器 人 的 转 问 流程 如 几 11-14 所 示 。 当 机 各 人 
在 行进 过 程 中 通过 智能 识别 闭 首 得 到 需要 转 癌 的 命令 时 ， 张 动 轮 停 止 运行 ， 机 左 人 在 原 地 运 
贴 壁面 吸附 不 动 。 中 央 大 吸盘 的 气动 回路 打开 ， 真 空 条 作用 于 中 央 大 吸盘 并 持续 吸 气 ， 当 中 
央 大 吸盘 单独 押 产 生 的 作用 足够 使 机 融 人 权 贴 壁面 不 清 动 时 ， 通 过 电 控 效 轩 使 两 边 履 市 吸盘 
的 杠杆 工作 放 气 ， 履 带 吸 盘 与 壁面 脐 落 。 竺 体 在 中 央 丙 轮 的 运行 下 以 大 吸盘 为 中 心 轴 开 始 转 
问 ， 转 加 完成 后 车 体 在 丝 杠 的 旋转 作用 下 回 壁 面 做 垂直 运动 ， 履 市 吸盘 同时 伴随 车 体 的 运动 
而 人 汉 压 壁 面 进而 完成 目 身 的 被 动 吸 气 过 程 。 符 所 有 履带 吸盘 吸附 壁面 完成 之 后 ， 中 央 大 吸盘 
的 气动 回路 关闭 ， 利 用 中 央 大 吸盘 的 杠杆 厂 置 完成 “ 放 气 ”过 程 ， 最 后 丝 杠 旋转 ， 中 央 大 吸 
熏 回 升 到 车 体 撒 盘 。 往 复 循 环 ， 芋 体 便 能 在 壁面 上 目 由 地 转 问 与 行进 。 
































需要 转向 
驱动 轮 停 转 中 央 大 吸盘 吸 气 | 一 | 乃 带 吸盘 放 气 


履 融 吸盘 压制 车 体 中 央 丝 车 体 中 央 检 
壁面 完成 目 映 杠 工作 ， 和 车 轮 旋转 ， 车 
的 被 动 吸 气 体 下 压 体 转 问 


少 二 
| 驱动 轮 正常 工作 ， 车 体 行进 
图 11-14 ”壁面 清洁 智能 机 带 人 的 转 问 流程 
7. 机 器 人 的 清洁 系统 
在 壁面 清洁 智能 机 右 人 行进 的 过 程 中 ， 安 装 在 车 体 上 和 面 的 清洁 系统 同时 进行 作业 。 清 洁 
系统 包括 筋 状 顺 淋 疙 四 、 深 简 刷 沈 装 置 和 刊 板 刊 洗 沪 置 。 刊 板 与 深 刷 实物 如 图 11-15 所 示 。 


























图 11-15 乔 板 与 滚 刷 实物 
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该 壁面 清洁 智能 机 器 人 采用 神 洗 、 刷 洗 、 乔 洗 联 合作 业 的 清洗 方式 ， 有 具体 的 清洗 过 程 为 : 
清洁 液 由 水 和 泵 喷 出 ， 首 先 冲洗 并 浸润 壁面 ， 随 后 由 滚 刷 刷洗 壁面 ， 除 去 附着 力 较 大 的 污垢 ; 
最 后 ， 由 刮 水 板 刮 净 残 留 的 液体 。 在 清洗 的 同时 ， 电 动机 带动 履带 转动 实现 行进 。 清 洁 装置 
前 置 ， 有 利于 死角 的 清洁 ， 清 洗 效 率 较 高 。 深 刷 安 装 在 车 体 的 前 方 ， 而 刊 板 安装 在 车 尾 ， 这 
样 有 利于 对 履带 行进 之 后 造成 的 痕迹 和 残留 的 污渍 进一步 清理 ， 可 尽量 减少 由 于 履带 行进 对 
幕墙 造成 的 污染 ， 使 幕墙 更 清洁 。 

8. 机 器 人 的 整体 装配 

将 吸附 机 构 、 行 进 机 构 、 转 癌 机 构 及 清洁 机 构 等 子 系统 组 闭 到 一 起 ， 束 构成 了 壁面 清洁 
智能 机 器 人 的 整体 结构 ， 整 体 装 配 图 如 图 11-16 所 示 ， 三 维 模 型 如 图 11-17 所 示 。 









































图 11-16 壁面 清洁 智能 机 如 人 的 整体 装配 图 


1 一 转向 机 构 ”2 一 底盘 ”3 一 同步 带 4 一 主 驱 动 电动 机 5 一 杠杆 触发 装置 ”6 一 转向 舵 机 
7 一 有 藉 托 架 ”8 一 真空 泵 “9 一 真空 泵 豫 动 电动 机 “10 一 三 角 架 11 一 连接 轴 12 一 深 刷 支架 
13 一 驱动 轴 14 一 文 撑 架 15 一 继 动 齿轮 副 “”16 一 配 气 齿轮 组 17 一 凸轮 机 构 











图 11-17 壁面 清洁 智能 机 器 人 的 三 维 模 型 
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11.3.2” 履 市 吸盘 了 式 行 走 委 置 力学 分 析 


1. 了 豚 盘 吸 附 幕 墙 的 力学 参数 
根据 吸盘 选用 样本 ， 计 算 吸 盘 的 吸附 力 
F=SP/W (11-14) 
王 直 起 吊 时 理论 起 钙 力 (吸附 力 ): 真空 吸盘 吸附 力 与 吸附 物 以 及 吸盘 吸附 面 的 摩 控 力 即 
为 维持 物体 的 力 〈 吸 附 力 ) 
F =0.1uSP (11-15) 
式 中 于 一 一 理论 起 是 力 (CN ); 
/一 一 摩 探 系数; 
5 一 一 吸盘 的 吸附 面积 (cm); 
P 真空 压力 (kPa)。 
2. 机 器 人 安全 性 论证 
(1) 摩 探 力 的 校 核 ”根据 式 〈11-15$)， 取 摩 探 系数 4L= 0.3 ， 负 压 已 =-S$0kPa ， 可 以 得 到 
每 个 吸盘 对 壁面 的 吸附 力 的 大 小 
F=0.3x0.1xnx(4/2) x50N =18.84N (11-16) 
正常 运行 时 ， 机 器 人 吸附 在 壁面 上 的 吸盘 共有 10 个 ， 则 吸盘 能 提供 的 吸附 力 总 大 小 为 
FF =188.4N 。 
机 器 人 的 目 重 为 














G=7.5x9.8=73.5N<F’ (11-17) 
因此 摩擦 力 足 够 。 
(2) 翻转 力矩 的 校 核 ”由 前 面 分 析 可 知 ， 要 使 机 器 人 在 运行 时 不 发 生 翻转 ， 只 需 满 足 式 
(11-8〉 即 可 ， 现 在 





SVp/d=5Sx18.84x0.05/0.06N =78.373N (11-18) 


因此 G<5Vp/Wd 满足 ， 机 器 人 在 运行 时 不 会 发 生 翻 转 。 
(3) 其 他 强度 参数 校 核 ”由 式 〈11-13) 可 得 主动 轮 轮 齿 底 部 受到 的 切 应 力 为 





= MPa =0.037MPa (11-19) 
电动 机 输出 的 扭转 力 窍 为 
T=9549xP/n=(9549x10x10™/6) N:m=15.915N.m (11-20) 
主动 轮 轮轴 受到 的 最 大 切 应 力 为 
T 本 三 (11-21) 


™ WW nD-o) nx(0.0D’ xd-0.6") 
取 安 全 系数 上 =2 ， 则 7 /k=46.5MPa 。 
(4) 仿真 软件 模拟 校 核 “借助 Solidworks 等 相关 软件 ， 可 以 很 好 地 模拟 相关 零件 的 受 力 
情况 ， 从 而 进行 模型 优化 。 壁 面 消 洁 管 能 机 占 人 的 压 盘 模型 如 图 11-18 所 示 。 网 11-19 和 和 网 
11-20 分 别 为 优化 前 与 优化 后 确 副 模型 的 受 力 与 变形 图 。 
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11-18 壁面 清洁 智能 机 器 人 的 底 副 模型 
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11-19 ”优化 前 底 副 原始 模型 受 力 与 变形 分 析 
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11-20 优化 后 确 盘 模型 受 力 与 变形 分 析 
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根据 所 指定 的 参数 ， 在 您 设计 中 所 
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昱 示 Von Mises 应 力 






显示 位 移 











在 以 下 显示 去 


加 全 RF0S) 站 
b: 的 位 置 


根据 所 指定 的 参 热 ， 在 您 设计 中 所 
找 硅 怕 0 艇 你 安 全 系 堵 (FOS) 旺 
186.231 

使 用 这 霸 入 制 双 看 动画 。 

播放 动 国 

回 六 止 动画 
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代 


中 


才 


壁面 清洁 智能 机 器 人 








完成 相关 的 力学 分 析 与 安全 性 论证 之 后 ， 所 搭建 的 壁面 消 滞 智 能 机 各 人 实物 样机 如 图 11-21 
所 示 。 图 11-22 为 样机 在 各 种 壁面 上 的 吸附 情况 。 





图 11-21 ”壁面 清洁 智能 机 器 人 实物 样机 ”图 11-22 ”壁面 清洁 智能 机 器 人 在 各 种 壁面 上 的 吸附 情况 
11.3.3 ”机 器 人 控制 系统 设计 


1. 控制 器 的 选择 及 外 围 电路 

壁面 清洁 智能 机 器 人 的 控制 器 采用 80C52 单片机 ， 如 图 11-23 所 示 。 该 类 单片机 共有 1 
个 串口 中 断 ，3 个 定时 器 中 断 ，2 个 外 部 中 断 ，4KB 的 程序 存储 容量 ， 最 小 系统 采用 的 是 
11.0592M 品 振 ， 性 能 速度 等 均 能 满足 要 求 ， 且 价格 合理 。 















40 口 VCC 
39 口 P0.O/A0 
38 口 PO.1/A1 
37 口 P0.2/A2 
36 口 P0.3/A3 
35 口 P0.4/A4 
34 口 P0.5/A5 
33 口 P0.6/A6 
32 口 PO.VA7 
31 口 EA 
30 口 ALE 
29 口 PSEN 
28 口 P2.7/A15 
27 口 P2.6/A14 
26 口 P2.5/A13 
25 口 P2.4/A12 
24 口 P2.3/A11 
18 23 口 P2.2/A10 
22 口 P2.1A9 
口 P2.0/A8 
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80C32/80C52 


图 11-23”80C52 实物 及 管 脚 图 


2. 电动 机 驱动 方式 及 电路 设计 

电动 机 的 驱动 采用 驱动 已 厂 驱 动 和 继电器 驱动 相 结 合 的 方式 。 

1)〉 了 驱动 芯片 驱动 : 驱动 芯片 采 用 L298N， 如 图 11-24 所 示 。 一 片 L298N 可 同时 驱动 
转 癌 电动 机 与 升降 电动 机 。L298N 的 驱动 电流 最 大 能 达 2.5A， 而 转 问 电动 机 与 升降 电动 
机 的 额定 电流 均 为 0.7A， 因 此 该 心 厂 完 全 可 以 完成 驱动 任务 。L298N 的 电路 图 如 图 11-25 
所 示 。 

2) 继 电 需 驱动 : 由 于 前 进 电 动机 需要 的 张 动 功率 较 大 ， 小 型 驱动 难以 解决 ， 又 考虑 
到 该 电动 机 的 控制 方式 较为 简单 ， 故 采用 继 电 需 驱动 。 采 用 的 是 PNP 型 三 极 管 对 单片机 引 
脚 输出 的 电流 进行 放大 ， 从 而 实现 单片机 直接 控制 继 电 占 的 工作 。 三 极 管 放大 电路 如 图 
11-26 所 示 。 
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图 11-24 L298N 实物 图 图 11-25 ”L298N 的 电路 图 


保护 二 极 管 





三 极 管 
GND 


图 11-26 三 极 管 放大 电路 


3. 无 线 通信 模块 

壁面 清洁 智能 机 器 人 采用 UTC1212 集成 无 线 通 信 模 块 ， 此 模块 的 功能 可 以 认为 是 无 线 串 
口 ， 开 发 方便 ， 操 作 人 简单 。 此 模块 由 发 射 模 世 和 接收 模块 组 成 。 发 射 模 鼎 只 需要 插 在 计算 机 
USB 口 即 可 ， 其 内 部 集成 了 串口 -USB 转换 电路 。 接 收 模块 只 需要 连接 7 条 线 ， 对 应 关系 为 
GUD-GND，VCC-VCC，TXD-RXD，RXD-TXD，SETA-GND，SETB-GND，AUX-GND， 电 
路 简单 多 操作 。 图 11-27 为 发 射 便 块 实物 图 ， 图 11-28 为 接收 模块 实物 图 。 











图 11-27 发 射 模块 实物 图 图 11-28 ”接收 模块 实物 图 


4. 上 位 机 的 设计 
采用 PC 机 作为 上 位 机 对 壁面 清洁 管 能 机 各 人 进行 远 距 离 监控 。 上 位 机 通过 无 线 串 口 控制 


电 


第 11 章 壁面 清洁 智能 机 器 人 


机 器 人 的 行走 ， 有 具体 操作 如 下 : 系统 通电 进入 初始 化 程序 ， 机 器 人 会 以 站 立 姿 势 等 待 上 位 机 
发 送行 走 指 令 ， 这 时 上 位 机 可 以 选择 发 送行 走 指令 ， 通 过 电脑 键 往 上 的 上 上、 下、 右键 可 
控制 机 器 人 前 进 、 人 停止、 左 转 和 右 转 。 几 11-29 为 上 位 机 界面 。 
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图 11-29 ”上 位 机 界面 
上 位 机 程序 编写 过 程 运用 了 VISA 资源 、 键 入 检测 和 其 他 控件 , 图 11-30 为 上 位 机 程序 界面 。 














VISA 资 源 名 称 : 





图 11-30 ”上 位 机 程序 界面 


图 11-31 为 整个 控制 系统 的 示意 图 。 壁 面 清洁 智能 机 天 人 的 控制 对 象 主要 包括 : 低压 电 
源 供给 、 巡 回路 径 规划 、 行 进 速度 控制 、 监 控 测 障 处 理 、 转 问 电 动机 控制 及 信号 识别 处 理 等 ， 
以 目前 的 功能 要 求 对 于 信息 的 需求 量 和 处 理 量 不 是 很 大 。 


了 驱动 机 


rr > 
转 问 转向 电动 机 


图 11-31 壁面 清洁 智能 机 如 人 控制 系统 示意 
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壁面 清洗 智能 机 器 人 的 整个 工作 过 程 可 描述 如 下 : 

1) 开 朋 电源， 局 动机 号 的 测 障 系统 ;起 动 气 到 马达 使 气 稍 开 始 工 作 ， 供 履 冲 吸盘 吸 气 的 芮 
空 发 生 左 《真空 稍 ) 打开 ， 连 接 中 央 吸 一 的 气管 电位 疾 关 财 ， 同 时 人 为 将 机 需 人 按压 于 硕 增 上 。 

2) 起 动 清 涪 系统 深 刷 驱动 电动 机 ， 深 刷 开 始 旋 转 工作 ， 同 时 局 动 响 水 装 转 。 

3) 起 动 主 张 动 电动 机 ， 履 市 主动 轮转 动 ， 机 器 人 开始 正 利 行进 ， 吸 气 系统 同步 工作 。 

4) 在 正 币 工作 与 行进 过 程 中 ， 当 测 障 《〈 可 以 考 夸 遥控 ) 系统 接受 并 判断 需要 园 辐 时 ， 履 
带 主 驱 动 电 动机 停止 运行 ， 清 洁 系 统 的 深 刷 和 喷 水 装置 停止 工作 ， 供 履带 吸盘 吸 气 的 吸 气 系 
统 停止 工作 。 

5) 中 央 吸 盘 的 气管 电磁 内 打 开 ， 供 转 癌 吸盘 吸 气 的 真空 发 生 朔 置 处 于 工作 状态 :机 吴 升 
降 电动 机 起 动 ， 张 动 中 央 吸 盘 垂 下 右 描 问 靠 近 需 描 的 方 同 运动 ， 中 央 吸 盘 完 成 吸附 过 程 后 ， 
机 号 升降 电动 机 停止 运行 《运动 时 间 控 制 参数 根据 实际 情况 确定 )， 起动 履 带 吸 盘 放 气 杠 杆 衣 
机 ， 使 两 侧 履 带 吸 盘 同 时 放 气 ， 放 气 完成 乙 后 履 珊 放 气 杠杆 能 机 复位 。 

6) 机 吴 转 回电 动机 起 动 ， 机 吴 开 始 转 癌 ， 转 癌 完 成 之 后 转 癌 电动 机 保 止 ， 机 吴 升 降 电动 
机 起 动 ， 张 动机 号 癌 乱 近 用 增 的 方 同 运动 ， 下 压 履 带 吸 盘 ， 当 履 市 吸盘 完成 被 动 吸附 之 后 机 
呈 升 降 电 动机 停止 ; 起动 中 央 吸 盘 杠 杆 此 机 给 中 央 吸 盘 放 气 ， 放 气 完成 之 后 此 杠杆 复位 ; 转 
问 电 动机 复位 以 准备 进行 下 一 次 转 癌 。 

7) 再 次 起 动 清 洁 系 统 深 刷 驱动 电动 机 ， 深 刷 开 始 旋 转 工 作 ， 局 动 贤 水 站 量 ， 开 始 咀 水 。 
起 动 主 驱动 电动 机 ， 履 带 主 动 纶 运行 ， 机 右 人 开始 行进 。 如 此 不 断 循环 ， 下 全 工作 完成 。 


下 区 目 主要 创新 点 儿 取 得 9 成 果 


11.4.1 作品 主要 创新 点 


1) 在 传统 爬 壁 机 费 人 的 基础 上 ， 实 现 了 履 市 吸盘 式 壁 面 机 费 人 的 成 功 研发 ， 大 幅度 近 融 
了 扑 壁 机 各 人 的 工作 效率 。 

2) 机 右 人 具有 嵩 承 载 能 力 的 特点 ， 可 通过 功能 模块 扩展 ， 厂 泛 应 用 于 不 同类 型 的 壁面 工 
作 任 务 ， 如 壁面 清河、 侦察、 消防 运输 等 。 

3) 采用 中 央 吸 盘 吸 附 机 构 设 计 ， 创 造 性 地 解决 了 履 市 朴 壁 机 需 人 转 回 困难 的 问题 ， 可 使 
机 占 人 转 丫 快速 、 平 稳 、 可 徘 。 

4) 采用 履 市 式 行走 机 构 设 计 ， 大 幅度 提高 了 扑 壁 机 右 人 运动 的 灵活 性 ， 通 过 搭 和 载 吸 附 效 
率 局 的 气 闪 式 吸盘 ， 保 证 了 吸附 可 徘 性 。 

5) 采用 机 电 一 体 化 式 控制 方式 ， 充 分 保证 了 各 运动 控制 环 市 之 间 的 紧密 配合 ， 实 现 了 极 
佳 的 控制 效 来 。 

6) 重 于 机 如 人 外 部 的 红外 感应 系统 能 够 目 动 识 列 障碍 并 完成 转 癌 绕 过 障碍 ， 同 时 结合 
线 痪 控 模 块 ， 实 现 了 单机 目 主 运行 和 人 机 交互 运行 两 种 运行 模式 。 

7) 机 磊 人 结构 设计 紧凑 ， 制 作成 本 低 ， 加 工 难度 小 。 


11.4.2 ”作品 取得 的 成 果 
作品 取得 的 成 果 如 下 : 




























































































电 


1) 壁面 清洁 智能 机 器 人 原理 样机 1 台 。 

2) 壁面 清洁 管 能 机 器 人 研究 技术 报告 1 份 。 

3) 申请 国家 发 明 专 利 2 项 : 

Q 履带 吸盘 式 壁 面 清洗 机 器 人 。 

@ 一 种 可 用 于 扑 壁 机 器 人 的 履带 吸盘 组 合式 行走 北 置 设计 。 
4) 获得 首都 高 校 第 六 届 机 械 创 新 设计 大 赛 一 等 奖 。 


已 结 与 展望 

















11.S.1 作品 研发 工作 总 结 


售 助 全 国 大 学 生机 械 创新 设计 大 赛 这 一 平台 ， 项 目 组 完成 了 履 珊 吸盘 式 壁 面 清洁 智能 机 
各 人 实物 样机 的 设计 与 制造 。 履 市 吸 登 式 壁 面 清 少 智 能 机 器 人 融合 了 真空 吸盘 吸附 方式 和 履 
审 邢 行走 方式 的 优点 ， 在 行进 速度 和 工作 效率 方面 具有 明显 的 优势 ， 而 且 履 带 吸盘 式 行进 方 
式 使 机 如 人 能 适应 更 多 的 工作 环境 ， 在 工作 适应 性 、 越 障 能 力 方面 具有 突出 的 优 后 。 

履带 吸盘 式 盛 面 清 少 知 能 机 磊 人 虽然 具有 很 多 优势 ， 但 仍 存 在 一 定 的 不 足 ， 如 转 同 能 
较 弦 、 吸 附 系统 的 称 定 性 不 局 等 。 为 了 使 壁面 清洗 智能 机 器 人 能 够 更 加 适应 各 类 辟 面 ， 保 证 
其 使 用 稳定 性 等 需求 ， 还 需 在 现 有 理论 和 实践 的 基础 上 开展 进一步 的 研究 ， 解 决 目前 疝 未 攻 
破 的 撤 术 难题 。 针 对 现 阶段 的 进展 情况 ， 提 出 以 下 可 进一步 研究 的 方 问 : 

1) 壁面 清洁 管 能 机 带 人 的 轻 量化 。 

2) 外 观 空气 动力 学 模型 优化 。 

3) 壁面 越 障 能 力 的 方 采 设计 。 

4) 路径 规 划 的 进一步 优化 。 

5) 清洁 效率 的 进一步 提 凯 。 

6) 有 恬 市 吸附 平台 的 推广 应 用 。 


11.5.2 ”作品 应 用 范围 及 前 景 分析 


壁面 清洁 智能 机 需 人 适用 于 高 楼 医 场 、 橱 窗 玻 璃 及 次 臣 壁 面 等 光滑 壁 向 ， 笔 真空 吸盘 的 
吸附 能 力 及 履带 的 行进 能 力 可 以 快速 地 完成 壁面 请 党 工作 ， 一 改 和 危险 遇 贯 、 工 作 环境 恶劣 的 
传统 山 篮 式 清 清醒 式 。 

除 清洁 功 能 外 ， 壁 面 清 滞 智 能 机 如 人 还 具有 其 他 极为 广泛 的 应 用 价值 。 拆 除 清洁 疙 管 ， 
可 将 整个 壁面 吸附 机 构 与 行进 系统 作为 一 个 搭载 平台 ， 应 用 于 以 下 几 个 方面 : 

1) 用 适当 的 猴 置 丛 换 清 清 系 统 ， 可 以 进行 高 空 建筑 物 的 检测 、 粉 料 涂 刷 、 壁 面 探 伤 及 辟 




































































面 修复 等 。 
2) 可 以 应 用 于 消防 作业 ， 进 行 高 层 建筑 受 困 人 员 的 搜索 、 搭 载 水 枪 实施 灭火 及 救援 物资 
的 传送 等 。 


3) 在 石化 工业 中 ， 可 用 于 金属 馈 内 部 探测 与 数据 玉 集 ， 并 能 够 噶 涂 防 愉 涂料 等 。 
4) 可 以 制作 成 仿真 壁虎 模型 , 不仅 可 以 满足 生活 娱乐 需求 ,还 能 在 苗 事 中 执行 侦察 任务 。 
5) 在 制造 业 中 ， 可 以 应 用 此 平台 进行 物资 传输 、 制 造 检 测 及 设备 内 部 的 网 像 采集 等 。 
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因此 ， 此 平台 可 以 在 制造 业 、 建 筑 业 、 石 油 化 工 等 领域 中 担任 十 分 重要 的 角色 。 壁 面 清 
洁 智 能 机 器 人 势必 在 工业 生产 链 中 起 到 不 可 或 缺 的 作用 ， 促 进 和 提高 产业 效率 ， 对 整个 工业 
生产 融 来 前 所 未 有 的 便利 。 但 是 ， 相 对 于 国外 的 研究 和 开发 而 言 ， 我 国 壁面 机 需 人 的 整体 现 
状 依然 有 一 定 的 兰 距 ， 因 此 需要 加 大 投入 进行 设计 开发 。 经 过 不 断 研究 、 设 计 和 单 新 ， 履 市 
吸盘 式 壁 面 清洁 智能 机 融 人 将 得 到 更 为 广泛 的 应 用 。 
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轻型 履带 式 机 动 平台 减 震 悬 挂 装置 专利 


专利 名 称 : 轻型 履 市 式 机 动 平 台 减 震 巧 挂 闭 年 
发 明 人 : 岁 庆 生 ; 昔 宝 玲 ， 徐 嘉 潘 登 ， 张 辉 





轻型 履 市 式 机 动 平台 减 震 悬 挂 委 置 


技术 领域 

本 发 明 涉及 一 种 适用 于 各 种 轻型 履带 式 机 动 平台 ， 尤 其 是 履带 式 移动 机 器 人 的 减 震 悬 挂 
装置 ， 该 装置 用 于 连接 轻型 履带 式 机 动 平台 负重 轮 与 车 体 ， 可 以 起 到 改善 平台 机 动 性 能 和 调 
节 履带 张 紧 程 度 的 作用 。 

背景 技术 

目前 ， 普 通 的 履带 式 车 辆 一 般 采 用 液压 、 气 压 、 扭 杆 阐 簧 等 悬挂 装置 ， 而 上 述 悬 排 装 置 
因 存 在 体积 庞大 、 结 构 复 杂 、 成 本 高 昂 等 缺点 ， 不 利于 直接 移植 到 轻型 履带 式 机 动 平 台 上 。 
现 有 的 轻型 履带 式 机 动 平台 悬挂 系统 往往 采用 直接 的 刚性 连接 或 者 简易 的 减 震 悬 挂 装置 ， 虽 
然 结构 简单 、 成 本 低廉 ， 但 减 震 效果 较 差 ， 不 能 适应 轻型 履带 式 机 动 平台 高 速 越野 机 动 的 实 
际 需要 。 此 外 ， 现 有 的 轻型 履带 式 机 动 平台 其 挂 装置 功能 单一 ， 缺 乏 宛 余 度 与 履带 张 紧 的 调 
节能 力 ， 这 些 都 制约 了 轻型 履带 机 动 平台 及 履带 式 移动 机 器 人 机 动 性 能 的 发 挥 。 

发 明 内 容 

本 发 明 涉及 一 种 适应 轻型 履带 式 机 动 平台 高 速 越野 机 动 要 求 的 可 调式 减 震 悬挂 装置 ， 克 
服 现 有 悬挂 装置 结构 、 体 积 、 功 能 及 成 本 上 的 缺点 ， 扩 展 减 震 悬 挂 系统 的 功能 ， 减 少 轻型 履 
带 式 机 动 平 台 行驶 时 的 震动 和 冲击 ， 提 高 其 机 动能 

本 发 明 是 通过 以 下 技术 方案 实现 的 。 该 减 震 悬 挂 装置 包括 直线 运动 球 轴承 、 螺 旋 弹 答 、 
承重 轮 、 承 重 轮轴 、 销 轴 、 橡 胶 垫 、 承 重 轮 连 杆 、T 形 转动 支架 、 导 向 移动 轴 、 悬 排 装 置 固定 
座 、 限 位 螺母 和 调节 垫圈 ， 其 中 承重 轮 连 杆 两 端的 通 孔 中 插 有 承重 轮轴 ， 承 重 轮 轴 两 端 安装 
承重 轮 ; T 形 转动 支 洪 下 端 通过 销 轴 与 承重 轮 连 杆 中 点 匀 接 ,构成 摆动 组 件 ， 使 得 承重 轮 连 杆 
可 以 绕 销 轴 小 范围 摆动 ;转动 支架 的 上 部 两 端 坚 直 插入 贯 守 螺 旋 弹 得 中 心 线 的 两 根 导向 移动 
轴 ， 导 向 移动 轴 的 上 端 穿 过 蕙 挂 装 置 固 定 座 ， 并 在 顶端 装 有 限 位 调节 螺母 ;螺旋 弹簧 被 限制 在 
所 述 工 形 转动 支架 与 悬挂 装置 固定 座 之 间 ， 构 成 弹簧 减 震 组 件 。 当 机 动 平台 通过 崎 嵌 路 面 时 ， 
导向 移动 轴 与 固定 座 产 生 相 对 位 移 ， 弹 筑 受 压 变形 ， 吸 纳 能 量 ， 实 现 减 震 ， 同 时 所 述 承 重 轮 
连 杆 绕 销 轴 转 动 ， 使 两 端 承 重 轮 可 以 依 地 形 起 伏 ， 收 到 缓冲 效果 ， 所 述 减 震 悬 挂 装置 通过 固 
定 座 与 车 体 连 接 并 固定 。 
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在 上 述 结构 中 ， 所 述 承 草 轮 连接 杆 上 部 两 端 艇 有 樟 瞳 垫 ， 当 连接 杆 与 转动 文 架 两 端 发 生 
接触 时 ， 押 述 橡胶 垫 起 到 平衡 、 绥 冲 和 降 品 作用。 

在 上 述 结 构 中 ， 所 述 螺旋 弹 复 与 转动 文 架 之 间 及 限 位 调节 螺母 与 悬挂 装置 固定 座 之 
间 逆 有 大 和 干 调节 垫 图 ， 通 过 增 减 垫圈 的 数量 与 厚度 ， 可 以 调节 悬 挂 系统 刚度 和 履带 张 紧 
程度 。 

在 上 述 结 构 中 ， 上 所 述 导 癌 移 动 轴 与 惹 挂 装 置 固定 座 之 间 装 有 直线 运动 球 轴承 ， 该 轴 
承保 证 了 导 问 移动 轴 与 悬挂 装置 固定 座 的 相对 径 向 精度 ， 同 时 不 影响 两 者 之 间 的 相对 轴 
器 运动 。 

上 述 结 构 中 ， 所 述 悬 挂 装 置 固定 座 与 机 动 平 台 底 盘 通过 螺栓 回 定 连接 。 

本 友 明 的 优点 效果 为 : 山 在 轻型 履 融 式 机 动 平 台 通 过 崎 虹 路 面 时 ， 巧 挂 装置 通过 弹 仁 变 
形 与 转动 支架 摆动 实现 双重 减 震 ， 极 大 地 提高 了 轻型 履带 式 机 动 平 台 的 越 障 能 力 与 行驶 稳定 
性 ，@ 该 悬挂 北 置 还 具有 展 好 的 调 市 功能 ， 可 根据 需要 调整 上 基 挂 系统 的 刚度 和 履带 的 张 紧 程 
度 ， 且 操作 方便 ， 机 动 灵活 ; @@ 使 用 直线 运动 球 轴承 ， 在 确保 轴 问 相对 运动 精度 的 同时 降低 
了 和 零件 的 摩擦 损耗 多 悬挂 装置 与 机 动 平 台 的 连接 方式 简单 、 牢 回 ， 实 现 了 匡 挂 系统 的 模块 
化 设计 ， 可 广泛 应 用 于 各 种 轻型 履带 式 机动 平 台 和 履带 式 移 动机 器 人 。 

附 图 说 明 

附 图 A-1 为 减 震 悬 挂 装 置 整体 结构 示意 图 。 

附 图 A-2 为 减 震 悬挂 逆 置 上 部 弹簧 减 震 组 件 分 解 结构 示意 网 。 

附 图 A-1 与 附 图 A-2 中 ，1 一 直线 运动 球 轴承 ;2 一 曲 旋 弹 知 ;3 一 承重 轮 ，4 一 销 轴 ; 5 
一 橡胶 热 ，6 一 承重 轮轴 ; 7 一 承重 轮 连 杆 ，8 一 了 T 形 转动 支架 ; 9 一 导向 移动 轴 ; 10 一 悬挂 装置 
固定 座 ;，11 一 限 位 螺母 ，12 一 调 万 热 交 。 


具体 实施 方式 


下 面 结合 附 图 A-1 与 附 图 A-2 对 本 发 明 作 进一步 说 明 。 

在 附 图 A-1 中 ， 两 根 承重 轮轴 6 罕 过 承重 轮 连 杆 7 两 端的 通 孔 ， 承 重 轮 3 对 称 安装 在 承 
重 轮轴 6 的 两 问 ， 承 重 轮 连 杆 7 与 工 形 转动 文 架 8 通过 销 轴 4 在 连 杆 中 点 贸 接 ， 使 得 纵 回 布 
置 的 承重 轮 组 件 在 通过 崎 虹 路 面 时 可 以 依 地 形 起 伏 发 生 人 往 转 ， 从 而 均匀 分 配 地 面 对 巧 挂 系统 
的 冲击 ;在 承重 轮 连 杆 7 可 能 与 T 形 转动 文 染 8 友 生 碰撞 的 位 置 租 有 橡胶 垫 5， 可 起 到 平衡 、 
绥 冲 和 降 品 的 作用 ;两 根 导 问 移动 轴 9 安装 在 T 形 转 动 支 架 8 的 上 部 两 端 ， 用 于 限制 螺旋 弹 得 
2 的 径 问 位 置 以 保持 一 定 的 稳定 性 ， 巷 挂 装置 国定 座 10 插入 两 根 导 问 移 动 轴 9 中 ， 其 间 插 入 
直线 运动 球 轴承 1， 来 降低 两 者 之 间 的 滑动 摩擦 ; 巧 挂 装置 国定 座 10 与 T 形 转动 文 染 8 共同 
限制 了 螺旋 弹 斗 2 的 轴 问 位置， 构成 了 葵 挂 系统 的 弹 引 减 震 机 构 ， 当 机 动 平台 通过 崎 民 路 和 耐 
时 ， 导 问 移 动 轴 9 与 基 挂 装置 固定 座 10 产生 相对 人 位移， 螺旋 弹 和 敬 2 受 压 变 形 ， 吸 纳 能 量 ， 实 
现 减 震 ; 在 导向 移动 轴 9 的 顶部 装 有 限 位 螺母 11， 用 于 限制 甚 挂 系 统 的 下 行 行程 ; 惹 挂 装置 固 
定 座 10 通过 4 个 螺栓 固定 在 机 动 平 台 底 盘 侧 壁 上 ， 实 现 了 悬挂 装置 的 模块 化 配置 ， 便 于 整体 
装 季 ， 且 定位 牢 奖 可 菲 。 

在 附 图 A-2 中 ， 调 节 垫 圈 12 的 数量 和 厚度 可 根据 需要 进行 增 减 ， 配 合 调 方 限 位 螺母 11， 
可 以 在 不 更 换 螺 旋 弹 营 2 的 情况 下 改变 悬挂 系统 的 刚度 和 履带 的 张 紧 程 度 。 
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附 图 A-1 ， 减 震 悬 挂 装置 整体 结构 示意 图 。” 附 图 A-2 减 震 悬挂 装置 上 部 弹 签 减 震 组 件 分 解 结构 示意 图 











轻型 履 市 式 机 动 平 台 履 市 目 动 张 杂交 置 专 利 








专利 名 称 : 轻型 履带 式 机 动 平 侣 的 履带 目 动 张 紧 装 置 
发 明 人 : 罗 庆 生 ， 昔 叹 玲 ， 徐 吝 ， 许 登 ， 张 将 


轻型 履 市 式 机 动 平台 的 履 审 自动 张 案 委 置 


技术 领域 

本 发 明 属 于 轻型 履带 式 机 髓 人 或 微小 型 履 市 式 芋 辆 领域 ， 具 体 涉及 一 种 轻型 履带 式 机 动 
平台 的 履带 目 动 张 紧 装置 。 

背景 技术 

在 履 市 式 机 动 平 人 台中， 不论 其 用 途 、 类 型 和 体积 如 何 ， 如 推 十 机、 挖掘 机、 军用 坦克 、 
小 型 履带 式 车 辆 每 ， 一 般 部 必须 设置 履带 张 崇 北 蚂 。 履 市 张 紧 装 置 具 有 可 在 履带 上 实现 、 调 
节 并 保持 适当 张 紧 力 的 功能 。 履 带 式 机 动 平 台 或 履带 式 车 辆 多 在 全 天 候 和 全 路 况 条 件 下 使 用 ， 
作业 环境 的 恶劣 性 和 作业 任务 的 艰巨 性 ， 使 得 履带 容易 发 生 弹性 伸 长 其 全 一 定 的 塑性 伸 长 ， 
由 于 履带 是 一 个 具有 轩 定 长 度 容 差 的 部 件 ， 为 了 适应 上 述 伸 长 ， 你 持 履 市 的 张 动力 ， 张 楷 装 
置 应 上 只 有 相应 的 履 市 张 楷 程度 调节 功能 。 

发 明 内 容 

本 发 明 的 目的 在 于 提供 一 种 适合 轻型 履 市 式 机 动 平台 或 币 小 型 履带 式 车 辆 的 履带 目 动 张 
公交 置 ， 该 朔 置 结构 简单 、 功 能 可 蚕 、 性 能 稳定 ， 能 够 极为 方便 的 调节 履带 的 张 紧 程 度 ， 而 
且 在 履带 弹性 伸 长 范围 内 还 具有 一 定 的 目 动 张 系 功能 。 

为 了 实现 上 述 发 明 目 的 ， 该 张 案 北 置 由 预 张 罕 组 件 和 目 适 应 张 坚 组 件 构成 。 预 张 紧 组 件 
包括 直线 运动 球 轴承 ， 和 直线 运动 球 轴承 分 别 插入 文 撑 轴 座 两 新 的 贺 孔 中 ， 并 用 弹性 接 闭 固定 ， 
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两 个 导 问 轴 罕 入 两 个 直线 运动 球 轴 承 的 内 座 疾 ， 直 线 运动 球 轴承 在 导 问 轴 上 应 活动 自如 ， 在 
导向 轴 的 两 端 各 装 上 导 问 轴 座 ， 再 用 内 六 角 螺 钉 把 导向 轴 座 固 定 在 车 体 上 从 动 轮 安装 位 置 处 
的 后 面 ， 弹 得 调节 座 的 位 置 在 支撑 轴 座 左 侧 ， 也 用 内 六 角 螺 钉 固定 在 车 体 上 ， 顶 紧 座 的 位 置 
在 支撑 轴 座 右 侧 ， 用 内 六 角 螺 钉 固定 在 车 体 上 。 自 适应 张 紧 装置 包括 两 个 弹 往 ， 弹 往 套 入 弹 
得 导 轴 中 ， 再 将 弹 徐 导 轴 固 定 在 弹 往 导 轴 座 上 。 该 履带 自动 张 紧 装置 的 特征 在 于 支撑 轴 座 (上 
面 连接 看 轻型 履带 式 机 动 平台 从 动 轮 ) 可 以 在 导 问 轴 上 前 后 运动 ， 而 支撑 轴 座 后 面 的 弹簧 又 
使 这 种 前 后 运动 在 一 定 范围 内 自动 完成 ， 最 终 保 证 了 履带 在 工作 过 程 中 始终 保持 着 适当 的 张 
紧 力 ， 使 履带 能 够 可 靠 地 发 挥 驱动 作用 。 

在 上 述 结 构 中 ， 上 所 述 的 弹 车 调节 座 和 顶 紧 座 的 螺纹 孔 内 分 别 闭 有 螺栓 ， 可 以 通过 调节 螺 
栓 的 旋 入 深度 来 确定 履 融 的 预 张 紧 范围 。 

在 上 述 结 构 中 ， 所 述 的 弹 霹 ， 通 过 弹 敬 的 自 适 应 变形 可 以 保证 履带 有 一 定 的 张 紧 力 自 动 
调节 范围 。 

本 发 明 的 优点 在 于 结构 简单 、 体 积 小 巧 、 重 量 轻 规 、 装 置 中 所 含 零件 较 少 ， 更 加 适合 在 
轻型 履 帝 式 机 器 人 或 微小 型 履带 式 车 辆 中 使 用 ， 特 别 是 此 张 紧 装 置 应 用 了 直线 运动 球 轴承 ， 
既 减 轻 了 摩 控 阻 力 ， 又 保证 了 运动 精度 ， 能 够 更 加 方便 地 调节 履带 的 张 紧 程 度 。 

附 图 说 明 

附 图 B-1 为 轻型 履带 式 机 动 平 台 整 体 布 局 示意 网 。 

附 图 B-2 为 轻型 履带 式 机 动 平 台 张 紧 闭 置 结 构 示 意 网 。 

附 图 B-1 和 附 图 B-2 中 : 1 一 车 体 ; 2 一 从 动 轮 ; 3 一 履带 ; 4 一 弹 筑 导 轴 座 ; $ 一 导向 轴 座 ; 
6 一 直线 运动 球 轴承 ; 7 一 文 撑 轴 座 ; 8 一 导 问 轴 ; 9 一 螺栓 ; 10 一 顶 紧 座 ; 11 一 文 撑 轴 ; 12 一 弹 
算 ，13 一 弹 引 导 轴 ;，14 一 弹 繁 调节 座 。 

具体 实施 方式 

附 图 B-1 所 示 为 轻型 履带 式 机 动 平台 的 整体 布局 示意 图 ， 本 发 明 的 张 紧 装 置 就 安装 在 车 
体 1 上， 履带 3 的 张 紧 程 度 是 依靠 该 张 紧 钱 置 改 变 从 动 轮 2 的 前 后 位 置 来 调节 的 。 

附 图 B-2 所 示 为 轻型 履带 式 机 动 平 台 张 紧 闭 置 的 结构 示意 网 ,直线 运动 球 轴承 6 分 别 
插入 文 撑 轴 座 7 两 端的 圆 也 中， 并 用 弹 和 车 挡 疾 回 定 ， 两 个 导 癌 轴 8 罕 入 两 个 直线 运动 球 轴 
承 6 的 内 座 圈 ， 直 线 运 动 球 轴承 6 在 导向 轴 上 应 活动 自如 ， 在 导向 轴 8 的 两 端 各 装 上 导向 
轴 座 $S， 再 用 内 六 角 螺 钉 把 寻 回 轴 座 $ 固定 在 车 体 1 上 从 动 轮 2 安 闭 位 置 处 的 后 面 ， 弹 车 
调节 座 14 的 位 置 在 文 撑 轴 座 7 左 侧 ， 也 用 内 六 角 螺 钉 固 定 在 车 体 1 上 ， 顶 又 座 10 的 位 置 
在 支撑 轴 座 7 右 侧 ， 用 内 六 角 螺 钉 固 定 在 车 体 1 上 ， 再 在 弹 先 调节 座 14 和 顶 紧 座 10 的 螺 
纹 孔 内 旋 入 螺栓 9， 接 着 把 弹 千 导 轴 13 装 在 阐 先 导 轴 座 4 上 ， 套 上 螺旋 弹 千 12， 然 后 将 
弹 竹 导 轴 座 4 推 入 弹 赞 调节 座 14 中 ， 最 后 将 文 撑 轴 11 闭 入 文 撑 轴 座 7 中 。 通 过 调节 螺栓 
旋 入 弹 复 调节 座 14 和 顶 紧 座 10 的 深度 ， 来 确定 一 个 预 张 紧 区 间 ， 使 支撑 轴 座 7 在 这 个 区 
间 内 运动 ， 而 加 入 弹 霹 12 和 弹 敬 导 轴 座 4 后 可 以 使 整个 装置 在 此 区 间 内 具有 一 定 的 自 适 
应 张 紧 力 调节 功能 ， 当 有 外 力 迫 使 履带 伸缩 时 ， 文 撑 轴 座 束 会 压缩 弹 车 ， 从 而 改变 从 动 轮 
的 位 置 确保 履带 的 张 紧 值 ; 当 外 力 消 失 后 ， 弹 车 将 文 撑 轴 座 推 问 原 来 的 位 置 ， 使 履带 恢复 成 
原 有 的 状态 ， 这 样 履 带 的 张 紧 程度 将 维持 在 合适 范围 内 ， 保 证 轻型 履带 式 机 器 人 或 微小 型 
履带 式 车 辆 的 正常 行驶 。 
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附 图 B-2 ”轻型 履 市 式 机 动 平台 张 紧 装 前 结构 示意 图 














响 琴 滥 小 型 四 履带 移动 机 器 人 驱动 装置 专利 

















专利 名 称 : 小 型 四 履 市 移动 机 如 人 驱动 北 申 
发 明 人 : 岁 庆 生 ; 韩 宝 玲 ， 徐 嘉 ， 潘 登 ， 张 辉 


小 型 四 履 市 移动 机 器 人 驱动 委 置 


技术 领域 
本 发 明 属于 地 面 移动 机 器 人 撤 术 领 域 ， 具 体 涉及 一 种 能 够 在 崎 虹 路 和 面 或 复杂 地 形 条 件 下 








机 动 行驶 ， 上 共有 较 品 机 动 性 和 较 强 越 障 力 的 小 型 四 履带 移动 机 右 人 驱动 祈 管 。 





育 景 技术 
近年 来 ， 地 面 移动 机 器 人 已 经 广泛 应 用 于 社会 生活 的 各 个 领域 ， 具 有 轻 、 小 、 快 等 优 操 


的 小 型 移动 机 器 人 无 其 受到 人 们 的 青睐 。 现 有 小 型 地 面 移动 机 器 人 通 利 应 用 于 车 事 侦察 、 安 
全 排 炮 、 特 殊 地 域 检测 等 领域 ， 在 功能 上 对 机 动 性 和 灵活 性 有 较 融 的 要 求 ， 而 在 驱动 结构 上 
又 仍 求 小 型 化 、 简 单 化 、 轻 量化 ， 如 何 从 设计 上 协调 好 功能 与 结构 两 者 之 间 的 关系 ， 是 小 型 
地 面 移动 机 项 人 设计 领域 的 难题 。 纵 观 国内 外 现 有 小 型 地 面 移 动机 喜人 驳 动 装置 ， 广 泛 采 用 
的 是 电动 机 加 传动 系 的 驱动 方式 ， 和 存在 结构 复兴、 体积 庞大 、 效 率 低 下 等 缺 皮 ， 尤 其 对 于 由 
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履带 移动 机 器 人 而 言 ， 行 走 、 摆 臂 两 套 驱动 传动 装置 会 占用 机 器 人 宝贵 的 空间 资源 ， 并 徒 增 
机 器 人 系统 的 重量 、 体 积 和 能 耗 ， 限 制 了 其 小 型 化 发 展 。 
发 明 内 容 


本 发 明 提 供 一 种 能 够 在 崎 邮 路 面 或 复杂 地 形 条 件 下 机 动 行驶 ， 上 其 有 较 融 的 机 动 性 和 较 强 
越 障 力 的 小 型 四 履 融 移动 机 器 人 驱动 朔 置 ， 目 的 是 在 保证 机 磊 人 共有 凯 机 动 性 和 强 越 障 力 的 
同时 ， 死 服 传统 驱动 、 传 动 系统 零件 众多 、 结 构 复 杀 、 效 率 低下 的 缺点 ， 降 低 系 统 能 耗 ， 硬 
省 内 部 空间 ， 减 轻 整 体重 量 ， 提 高 机 器 人 的 工作 可 车 性 和 行驶 税 定 性 ， 为 小 型 履 融 式 地 面 移 
动机 堪 人 张 动 猴 置 提供 新 的 设计 方案 和 新 的 技术 途径 。 

为 解决 上 述 扩 术 问题 本 发 明 采 用 的 技术 方案 是 : 一 种 小 型 四 履 市 移动 机 器 人 张 动 装置 ， 
包括 箱 体 、 堪 右 对 称 布 置 的 行走 驳 动 装置 、 摆 展 张 动 装置 和 摆 避 组 件 。 其 中 行走 驱动 朔 置 位 
于 箱 体 后 部 ， 包 括 左右 对 称 布 置 在 箱 体 两 侧 的 主动 轮 、 从 动 轮 、 行 走 履 市 ， 主 动 轮 内 部 僚 有 
行走 驱动 电动 机 ， 行 走 张 动 电动 机 在 张 动 主动 轮转 动 的 同时 起 到 主动 轮轴 的 作用 ; 行走 驱动 
电动 机 输出 端 插 入 主动 轮 联 轴 融 中 ， 并 通过 汉 定 蛙 钉 和 键 带 动 联 轴 器 转动 ， 主 动 轮 联 轴 需 通 
过 键 连接 禹 动 主动 轮 ， 主 动 轮 外 侧 设 有 弹性 挡 轿 ;行走 驱动 电动 机 通过 紧 定 蝶 钉 固定 在 移动 
座 中 ， 移 动 座 可 以 在 箱 体 后 部 的 主动 轮轴 固定 座 中 前 后 移动 ， 从 而 调节 主动 轮 的 前 后 位 置 ， 
起 到 张 泽 调 市 的 作用 。 摊 辟 驱 动 北 前 包括 布置 在 从 动 轮 外 侧 同 轴 的 控 恬 轮 ， 从 动 轮 通过 绕 轮 
轴 周 向 对 称 布置 的 四 根 摊 辟 轮 同步 销 带 动 摆 辟 轮 ， 你 证 摊 辟 轮 与 从 动 轮转 速 相同 ， 摆 民 轴 座 
贯 笃 从 动 轮 和 摆 避 轮 中 心 ， 并 且 通 过 曼 色 固定 在 箱 体 侧 壁 上 ;， 摆 臂 轴 座 中 套 有 摆 辟 张 动 电动 
机 ， 电 动机 输出 轴 通 过 摆 臂 联 轴 器 带动 摆 臂 组 件 转动 。 摆 辟 履 人 带 组 件 包括 内 避 ， 外 臂 ， 摆 名 
张 票 组件， 前段 文 板 ， 摆 展 小 轮 和 摆 避 履 珊 ， 其 中 内 殿 套 接 在 从 动 轮 和 摆 臂 轮 之 间 ;， 外 臂 转 
动 中 心 与 摆 尼 轮 同 轴 ， 且 与 摆 展 联 轴 需 回 连 ; 摆 展 张 宗 组 件 连接 了 内 外 臂 及 前 段 文 板 ， 对 摆 
臂 履 带 起 张 梭 作用 。 

所 述 行走 驱动 电动 机 输出 轴 的 外 端面 与 主动 轮 外 侧 平 章 ， 最 大 限度 地 减少 了 行走 驱动 电 
机 在 箱 体内 所 占 的 空间 。 

所 述 摆 辟 驱动 电动 机 完全 包含 在 摊 禹 轴 座 中 ， 市 省 了 空间 。 

所 述 移动 座 通 过 与 移动 座 兰 板 固 接 形 成 工 衬 清 世 ， 进 而 衣 入 主动 轮轴 固定 座 和 箱 体 侧 避 
形成 的 导轨 中 。 

所 述 主动 轮轴 固定 座 的 两 端 各 有 一 根 紧 定 螺 栓 ， 用 于 限定 移动 座 的 位 苟 ， 进 而 限定 主动 
轮 的 张 票 位 置 ， 实 现 对 行走 履带 的 张 楷 。 

所 述 从 动 轮 和 摊 辟 轮 之 间 还 站 有 两 个 阳 较 ， 对 站 的 隅 图 固定 了 控 辟 轴承 的 位 置 。 

所 述 摆 懂 轮 同 步 销 贯 罕 两 个 隔 圈 ， 且 其 两 站 分 别 插 入 从 动 轮 和 摆 展 轮 中 。 

所 述 摆 辟 张 宗 组 件 包括 固定 在 内 避 和 外 臂 之 间 的 顶 紧 座 ， 两 根 导 回 轴 插 入 项 紧 座 中 ， 清 
动 座 插入 两 根 导 问 轴 中 ， 并 可 沿 导 问 轴 移动 ， 滑 动 座 通 过 紧 定 螺钉 限定 其 与 导 回 轴 的 相对 位 
置 ， 两 个 前 段 文 板 问 定 在 请 动 座 的 两 端 ， 摆 展 小 轮 安装 在 前 段 文 板 的 最 前 中。 

本 发 明 的 有 益 效 果 为 : 电动 机 作为 主动 轮轴 ， 对 主动 轮 起 到 文 撑 、 定 位 和 驱动 的 多 重 作 
用 ， 简 化 了 传动 机 构 ， 省 去 了 传统 传动 方式 中 的 轴承 件 ， 减 轻 了 张 动 装置 的 重量 ， 此 外 ， 主 
动 轮 一 与 摆 臂 都 是 由 驱动 电动 机 直接 驱动 ， 省 去 了 烦 珊 的 传动 机 构 ， 最 大 限度 地 记 省 了 空间 ， 
降低 了 系统 故 隐 率 ， 为 移动 机 圳 人 进一步 小 型 化 、 轻 量化 提供 了 解决 方案 。 
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附录 


附 图 说 明 

附 图 C-1 是 小 型 四 履带 机 器 人 总 体 结 构 示 意图 。 

附 图 C-2a 是 小 型 四 履带 机 器 人 行走 驱动 装置 剖 视 图 ， 附 图 C-2b 是 小 型 四 履带 机 器 人 行 
走 驱 动 冯 置 分 解 示 意图 。 

附 图 C-3 是 小 型 四 履带 机 器 人 摆 臂 驱动 装置 副 视 图 。 

附 图 C-4 是 小 型 四 履带 机 器 人 摆 臂 组 件 结构 示意 图 。 

附 图 C-5 是 小 型 四 履带 机 器 人 俯视 网 。 

附 图 C-1 一 附 图 C-5 中 ; 1 一 箱 体 ，2 一 主动 轮 ; 3 一 行走 履带 ;4 一 从 动 轮 ; 5 一 摆 恬 轮 ; 
6 一 捍 辟 履带 ; 7 一 捍 辟 小 轮 ， 8 一 弹性 挡 圈 ;: 9 一 主动 轮 联 轴 器 ; 10 一 调节 螺栓 ;11 一 行走 履带 
驱动 电动 机 ; 12 一 移动 座 盖 板 ; 13 一 主动 轮轴 国定 座 14 一 移动 座 ; 15 一 隔 阐 ;16 一 捍 辟 轮 
司 步 销 ;，17 一 摆 臂 联 轴 器 ;18 一 外 臂 ，19 一 内 臂 ;，20 一 摆 辟 轴承，21 一 摆 臂 驱动 电动 机 ，22 
一 摆 臂 轴 座 ，23 一 前 段 支 板 ，24 一 顶 紧 座 ;，25 一 滑动 座 : 26 一 导向 轴 。 

具体 实施 方式 

下 面 结合 附 图 C-1 一 附 图 C-5 对 本 发 明 作 进一步 说 明 。 

本 发 明 小 型 四 履带 移动 机 器 人 驱动 装置 ,包括 箱 体 1、 左 右 对 称 布置 的 行走 履带 张 动 钞 置 、 
摆 臂 驱动 装置 和 摆 臂 履带 组 件 。 其 中 行走 履带 驱动 装置 位 于 箱 体 1 后 部 ， 包 括 对 称 布置 在 箱 
体 1 外 部 两 侧 的 主动 轮 2、 行 走 履 带 3、 从 动 轮 4、 弹 性 挡 疾 8、 主 动 轮 联 轴 嚣 9、 调 节 螺 栓 
10、 行 走 履 带 驱 动 电动 机 11、 移 动 座 盖 板 12、 主 动 轮轴 固定 座 13、 移 动 座 14 和 若干 标准 紧 
固件 。 行 走 履 市 张 动 电动 机 11 的 前 端 及 输出 轴 插 入 主动 轮 联 轴 需 9 的 中 心 通 孔 中 ， 电 动机 输 
出 轴 的 外 奖 面 与 主动 轮 联 轴 堪 9 中 心 通 孔 的 外 端面 平 齐 ， 再 通过 紧 定 螺钉 和 平 键 实 现行 走 履 
带 驱 动 电动 机 11 和 主动 轮 联 轴 需 9 的 相对 周 同 和 轴 癌 固定 ;然后 将 连 为 一 体 的 行走 履 融 张 动 
电动 机 11 和 主动 轮 联 轴 器 9 一 同 插入 主动 轮 2 的 中 心 通 孔 中 ， 主 动 轮 联 轴 器 9 上 开 有 弹性 挡 
圈 卡 槽 ， 通 过 弹性 挡 圈 8 便 主 动 轮 2 实现 在 主动 轮 连 轴 器 9 上 的 轴 向 定位 ， 主 动 轮 连 轴 器 9 
再 通过 平 键 连接 带动 主动 轮 2， 这 样 当 行走 履带 张 动 电动 机 11 在 通过 主动 轮 连 轴 需 9 驱动 主 
动 轮 2 转动 时 ， 电 动机 输出 轴 连 同 主动 轮 联 轴 需 9 一 起 束 会 起 到 主动 轮 2 的 轮轴 作用 。 行 走 
履带 驱动 电动 机 11 通过 又 定 螺钉 固定 在 移动 座 14 中 ， 移 动 座 14 可 以 在 箱 体 1 后 部 的 主动 轮 
轴 固 定 座 13 中 前 后 移动 ， 以 调节 主动 轮 2 的 前 后 位 置 ， 起 到 调和 世 行 走 履带 张 紧 程 度 的 作用 。 

摆 臂 驱动 装置 包括 摆 臂 轮 5， 隔 圈 13、 摆 臂 轮 同 步 销 16、 捍 辟 联 轴 嚣 17、 摆 臂 驱 动 电动 机 
21、 摆 臂 轴 座 22 和 若干 标准 件 。 捍 辟 轮 5 位 于 从 动 轮 4 外 侧 ， 且 与 从 动 轮 4 同 轴 ; 从 动 轮 4 通 
过 绕 轮 轴 周 问 对 称 布置 的 四 根 择 避 轮 同步 销 16 市 动 摆 臂 轮 $S， 保 证 摆 辟 轮 5 与 从 动 轮 4 转速 相 
同 ; 摆 臂 轴 座 22 通过 螺钉 固定 在 箱 体 1 侧 辟 上， 并 且 贯 穿 从 动 轮 4 和 摆 臂 轮 5 中心， 在 从 动 轮 
4 和 摆 臂 轮 5 转动 时 一 起 到 轮轴 的 作用 ;， 捍 臂 驱动 电动 机 21 的 输出 轴 插 入 捍 辟 联 轴 右 17 的 通 
孔 中 ,再 通过 紧 定 螺钉 和 平 键 实现 摆 臂 张 动 电 动机 21 和 摆 臂 联 轴 需 17 的 相对 周 同和 轴 辐 固定 ; 
然后 将 连 为 一 体 的 摆 臂 驱动 电动 机 21 和 摆 臂 联 轴 器 17 一 同 插入 摆 臂 轴 座 22 的 通 孔 中 , 进而 通 
过 么 定 螺钉 固定 摆 臂 驱动 电动 机 21 在 摆 臂 轴 座 22 中 的 周 同 和 轴 癌 位 置 ; 外 辟 18 通过 螺钉 固定 
在 摆 臂 联 轴 需 17 外 端 ， 从 而 使 摆 臂 丝 动 装置 可 以 带动 摆 臂 组 件 做 360” 转动 。 

摆 辟 履 融 组 件 包 括 摆 臂 履 珊 6、 外 臂 18、 内 臂 19、 摆 臂 轴 承 20、 摆 臂 张 紧 组 件 、 前 段 文 
板 23 及 大 和 干 标准 件 。 其 中 内 臂 19 套 接 在 从 动 轮 4 和 摆 臂 轮 5 之 间 的 摆 臂 轴承 20 上 ; 外 臂 18 
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的 转动 中 心 与 摆 臂 轮 5 同 轴 ， 且 与 摆 臂 连 轴 器 17 固 连 ， 摆 臂 张 紧 组 件 连接 了 内 臂 19、 外 臂 
18 及 前 段 支 板 23， 对 摆 臂 履带 6 起 张 紧 作 用 。 

所 述 摆 臂 丝 动 电动 机 21 完全 包含 在 摆 臂 轴 座 22 中 。 

所 述 移动 座 14 通过 与 移动 座 盖 板 12 固 接 形 成 工 字 滑 块 ， 进 而 能 入 主动 轮轴 固定 座 13 和 
箱 体 1 侧 壁 形成 的 导轨 中 。 

所 述 主动 轮轴 固定 座 13 的 两 端 各 有 一 根 紧 定 坚 栓 10， 用 于 限定 移动 座 14 的 位 置 ， 进 而 
限定 主动 轮 2 的 张 紧 位 置 ， 实 现 对 行走 履带 3 的 张 紧 。 

所 述 从 动 轮 4 和 摆 臂 轮 5 之 间 还 儿 有 两 个 隔 圈 15， 对 浅 的 隔 峰 15 固定 了 摆 臂 轴承 20 的 
位 置 。 

所 述 摆 辟 轮 同步 销 16 贯穿 两 个 隔 圈 135， 且 其 两 端 分 别 插入 从 动 轮 4 和 捍 辟 轮 5 中。 

所 述 摆 臂 张 紧 组 件 包 括 摆 臂 小 轮 7、 前 段 文 板 23、 顶 紧 座 24， 滑 动 座 25 和 导 癌 轴 26。 顶 
紧 座 24 固定 在 内 臂 19 和 外 臂 18 两 者 前 端 之 间 ， 两 根 导 问 轴 26 搬入 顶 紧 座 24 中 ， 滑 动 座 25 
插入 两 根 导 问 轴 26 中 ， 并 可 治 导 回 轴 26 移动 ， 滑 动 座 25 通过 紧 定 螺钉 限定 其 与 导 癌 轴 26 的 
相对 位 置 , 两 个 前 段 文 板 23 固定 在 滑动 座 25 的 两 端 , 摆 臂 小 轮 7 安装 在 有 前段 文 板 23 的 最 前 端 。 

下 面 结合 附 图 C-1 一 附 图 C-5 对 本 发 明 工 作 原 理 做 进一步 说 明 。 小 型 四 履带 移动 机 器 人 驱 
动 装置 ， 如 附 图 C-1 所 示 ， 机 器 人 整体 为 左右 对 称 结构 ， 行 走 驱 动 装 置 驱 动 主动 轮 2 转动 ， 主 
动 轮 2 带动 行走 履带 3, 并 将 转动 传递 给 箱 体 前 部 的 从 动 轮 4, 实现 机 器 人 在 地 面 的 行走 。 同时， 
从 动 轮 4 将 转动 传递 给 摆 臂 轮 S， 从 而 市 动 摆 臂 履 带 6 转动 ， 实现 机 右 人 的 攀 仆 功能 。 当 左右 两 
个 驱动 装置 差 动 时 ， 可 以 实现 机 器 人 转 问 。 如 附 图 C-2 所 示 ， 行 走 驱 动 电动 机 11 直接 通过 主动 
轮 联 轴 器 9 驱动 主动 轮 2 转动 ， 同 时 ， 行 走 驱 动 电动 机 11 固定 在 移动 座 14 中 ， 又 起 到 主动 轮 
轴 的 作用 。 通 过 调 市 主动 轮轴 固定 座 13 两 问 的 紧 定 螺栓 10 可 以 限定 移动 座 14 的 位 置 ， 从 而 实 
现 对 机 器 人 行走 履 市 3 的 张 紧 。 如 附 图 C-3 所 示 ， 摊 恬 驱 动 电动 机 21 固定 在 摆 臂 轴 座 22 中 ， 
并 且 通 过 摆 臂 联 轴 器 17 直接 驱动 外 辟 18 转动 ， 从 而 驱动 整个 摆 臂 组 件 转动 。 从 动 轮 4 与 捍 辟 
轮 5 都 套 在 摆 臂 轴 座 22 外 部 ， 其 间隔 有 两 个 隔 较 135， 当 从 动 轮转 动 时 ， 四 根 担 臂 轮 同步 销 16 
市 动 摆 臂 轮 5 一 起 转动 ， 保 证 了 摆 臂 轮 5 与 从 动 轮 4 同步 转动 。 如 附 图 C-4 所 示 ， 顶 紧 座 24 
固定 在 内 臂 19 和 外 避 18 之 间 ， 将 二 者 回 连 ， 移 动 座 25 可 以 在 固定 在 项 紧 座 24 上 的 两 根 导 问 
轴 26 上 滑动 ， 并 通过 螺钉 锁定 位 置 ， 从 而 实现 对 摆 臂 履带 6 的 张 紧 。 附 图 C-5 所 示 为 机 器 人 豫 
动 装置 俯视 图 ， 可 见 本 发 明 最 大 限度 地 厄 省 了 机 器 人 箱 体 的 内 部 空间 。 

说 明 书 附 图 













































































附 图 C-1 小 型 四 履 市 机 絮 人 总 体 结构 示意 图 
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附 图 C-3 小 型 四 履 刘 机 器 人 摆 臂 驱动 装置 训 视 网 


@ 


附录 


大 学 生 课 外 科技 创新 竞赛 获奖 作品 精 析 


SN 









DW 







附 图 C-4 ”小 型 四 履 种 机 絮 人 摆 辟 组 件 结构 示意 图 
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附 图 C-5 小 型 四 履带 机 左 人 集 视 岁 


小 型 信 履 市 全 地 形 移 动机 器 人 专利 


专利 名 称 : 小 型 六 履带 全 地 形 移动 机 各 人 
发 明 人 : 韩 宝 玲 ， 罗 庆生 ; 徐 器 ; 潘 登 ， 张 溜 


小 型 六 履 市 全 地 形 移 动机 器 人 





技术 领域 








本 发 明 属 于 地 面 移 动机 器 人 技术 领域 ， 共 体 涉及 一 种 能 够 在 师 虹 路 而 或 复杂 地 形 条 件 下 





机 动 行驶 ， 上 共有 较 高 机 动 性 和 较 强 越 障 力 的 小 型 六 履带 全 地 形 移动 机 器 人 。 
背景 技术 





地 面 移动 机 帮 人 已 有 数 十 年 的 发 展 历 史 ， 在 当今 社会 生活 的 各 个 领域 部 有 看 广泛 的 应 用 ， 











如 军事 侦察 、 排 烃 、 和 危险 品 探 测 、 灾 害 救援 等 。 该 类 机 副 人 的 基本 驱动 方式 通常 采用 轮 式 、 
履 市 式 或 轮 履 复合 式 。 按 照 传 统 的 设计 思路 ， 现 有 移动 机 器 人 的 机 动 受 活性 和 越 障 能 力 较 产 ， 
在 通过 崎 蚁 路 面 和 翻越 隐 但 时 ， 经 各 会 发 生机 器 人 展 盘 被 碎 石 或 突 缘 卡 住 的 现象 ， 部 分 机 器 
人 采用 了 摆 臂 来 抬升 驱 体 、 翻 越 隐 但 ， 但 是 这 种 方法 避 时 费力 ， 降 低 了 移动 机 融 人 的 机 动 速 
上 度 和 消耗 了 其 有 限 的 能 源 。 因 此 ， 要 区 服 现 有 移动 机 闫 人 机 动能 力 上 问 有 的 缺陷 ， 需 要 从 移 
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动机 磺 人 行走 机 理 和 张 动 方式 上 寻求 突 仆 。 
发 明 内 容 


本 及 明 提 供 一 种 能 够 在 崎 蚁 路面 或 复杂 地 形 条 件 下 机 动 行 驶 ， 具 有 较 局 机 动 性 和 较 强 越 
障 力 的 小 型 六 履 囊 全 地 形 移动 机 器 人 ， 目 的 是 在 你 证 机 器 人 做 才 限制 的 同时 ， 死 服 传统 履 市 
式 移动 机 器 人 展 盘 经 名 与 隐 依 发 生 全 撞 的 缺点 ， 提 高 机 器 人 的 机 动能 力 ， 为 小 型 履 市 式 地 面 
移动 机 器 人 结构 布局 提供 新 的 设计 方案 和 新 的 扩 术 途径 。 

为 解决 上 述 技术 问题 本 发 明 采 用 的 技术 方案 是 :一 种 小 型 六 履 融 全 地 形 移动 机 句 人 ， 包 括 
两 套 行 走 驱 动 北 四 、 四 套 摆 辟 组 件 及 机 号 框架 。 机 右 人 左 行走 履带 与 右 行 走 履带 左右 对 称 
置 ， 上 履 兰 了 机 井 人 机 号 框 如 的 上 、 下 、 前 、 后 表面 ， 张 动 电动 机 、 控 制 系统 及 动力 电源 都 包 
售 在 被 左 行 走 履 市 和 右 行走 履 市 履 焉 的 机 喘 框 如 内 :左前 摆 臂 驱动 逆 置 和 右前 摆 避 张 动 闭 置 
安 钱 在 机 融 人 前 关 左 右 两 侧 ， 堪 后 摆 臂 张 动 朔 置 和 右 后 摆 展 张 动 装 症 安 厂 在 机 需 人 后 器 左右 
两 侧 ; 左 行走 驱动 装置 和 右 行走 驱动 闭 置 都 位 于 左前 摆 辟 驱动 装置 和 右前 摆 臂 驳 动 装置 的 内 
侧 ， 左 前 摆 辟 履带 、 左 后 摆 懂 履带 与 左 行走 履 市 的 线 速度 相同 ， 右 前 摆 民 履 珊 、 右 后 摆 懂 履 
市 与 右 行 走 履 融 的 线 速度 相同 ， 在 翻越 障 但 时 ， 四 个 摆 避 可 以 起 到 文 撑 、 擎 附 的 作用 ;， 机 器 
人 上 部 还 装 有 承载 平台 ， 可 用 于 安装 各 种 设备 附件 。 

所 述 左 行 走 驱 动 狼 萤 包 括 左 行走 驱动 电动 机 、 无 行走 链 传动 系 、 左 小 资 轮 、 左 小 轴 、 
左 大 次 轮 、 左 前 主轴 、 左 击 内 行走 链 轮 、 左 前 外 行走 链 轮 和 左 行走 履 和 市 。 左 行走 驱动 电动 
机 固定 在 机 里 左 侧 板 内 侧 ， 且 其 输出 轴 军 过 左 侧 板 ， 左 行走 链 传动 系 将 电动 机 转动 传递 给 
问 定 在 左 小 轴 上 的 左 小 齿轮 ， 左 小 齿轮 再 将 转动 传递 给 固定 在 左前 主轴 上 左前 内 行走 链 
轮 、 左 前 外 行走 链 轮 中 间 的 左 大 上 元 轮 ， 从 而 带动 左前 内 行走 链 轮 和 左前 外 行走 链 轮 转动 ; 
左前 内 行走 链 轮 和 左前 外 行走 链 轮 与 左 行走 履 市 内 侧 的 链条 吵 合 ， 和 市 动 履带 转动 ， 实 现 机 
人 钠 人 的 行走 功能 。 所 述 右 行 走 驱 动 汪 置 包括 右 行 走 驱 动 电动 机 、 夺 行走 链 传 动 系 、 石 小 上 
轮 、 碳 小 轴 、 右 大 丙 轮 、 右 前 主轴 、 右 前 内 行走 链 轮 、 右 前 外 行走 链 轮 和 右 行 走 履带 。 石 
行走 驱动 电动 机 固定 在 机 映 右 侧 板 内 侧 ， 且 其 输出 轴 罕 过 右 侧 板 ， 右 行走 链 传 动 系 将 电动 
机 转动 传递 给 固定 在 右 小 轴 上 的 右 小 丙 轮 ， 石 小 齿轮 再 将 转动 传递 给 固定 在 右前 主轴 上 碳 
前 内 行走 链 轮 、 右 前 外 行走 链 轮 中 间 的 右 大 齿轮 ， 从 而 带动 右前 内 行走 链 轮 和 右前 外 行走 
链 轮 转动 ;右前 内 行走 链 轮 和 右前 外 行走 链 轮 与 右 行走 履 市 内 侧 的 链条 吗 合 ， 市 动 履 市 转 
动 ， 实 现 机 髓 人 的 行走 功能 。 

所 述 左前 摆 辟 张 动 效 首 包括 左前 摆 臂 电动 机 、 左 前 摆 臂 驱动 链 轮 、 堪 前 内 轴 套 、 左 前 外 
轴 侠 、 左 前 摆 辟 杆 、 左 前 摊 恬 小 轴 、 左 前 内 授 禹 小 链 轮 、 左 前 外 摊 辟 小 链 轮 、 左 前 内 授 恬 大 
链 轮 和 左前 外 摊 禹 大 链 轮 ， 左 前 摆 芒 大 链 轮 安 狼 在 左前 摊 辟 杆 前 痢 的 左前 摊 禹 小 轴 上 ; 左前 
内 轴 僚 、 左 前 摊 恬 驱动 链 轮 、 左 前 外 轴 侠 和 左前 摊 辟 杆 依次 通过 螺栓 串 接 固 连 在 一 起 ， 并 通 
过 轴承 套 接 在 左前 主轴 上 ， 其 中 左前 内 轴 套 穿 过 机 吴 左 侧 板 ， 两 者 之 间 套 有 轴承 ， 这 样 可 以 
你 证 左前 摆 臂 相对 于 雹 前 主轴 和 机 号 元 侧 板 目 由 转动 ， 左 前 摆 避 电 动机 冉 定 在 机 吴 左 侧 板 内 
侧 ， 且 其 输出 轴 罕 过 左 侧 板 ; 左前 摆 臂 电动 机 通过 链 传动 市 动 左 前 摆 展 张 动 链 轮 转动 ， 从 而 
市 动 左 前 摊 辟 杆 转动 ， 进 而 完成 机 费 人 左前 摊 辟 的 转动 ， 左 十 内 摊 恬 小 链 轮 和 左前 外 摊 辟 小 
链 轮 与 天 前 内 行走 链 轮 外 径 相 同 ， 且 通过 键 连接 套 接 在 左前 主轴 外 顺 ， 与 左前 主轴 同步 转动 ， 
因此 顽 前 内 摆 臂 小 链 轮 和 左前 外 摆 展 小 链 轮 可 带动 左前 摆 臂 履带 与 左 行 走 履 带 保持 相同 的 线 
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速度 ; 左前 摆 展 驳 动 猴 置 与 左前 摆 臂 履 市 组 成 左前 摆 臂 组 件 。 所 述 右前 摆 避 张 动 装 首 包括 右 
前 摆 辟 电动机、 右前 摆 臂 旨 动 链 轮 、 右 前 内 轴 套 、 右 前 外 轴 套 、 碳 前 摆 臂 杆 、 右 前 摆 臂 小 轴 、 
右前 内 摆 避 小 链 轮 、 右 前 外 摆 臂 小 链 轮 、 石 前 内 摆 臂 大 链 轮 和 右前 外 摆 避 大 链 轮 ;右前 摆 避 
大 链 轮 安 疲 在 右前 摆 展 杆 前 站 的 右前 摆 展 小 轴 上 ;右前 内 轴 套 、 右 前 摆 展 驳 动 链 轮 、 右 前 外 
轴 套 和 右前 摆 臂 杆 依 次 通过 螺栓 毕 接 固 连 在 一 起 ， 并 通过 轴 藉 套 接 在 右前 主轴 上 ， 其 中 右前 
内 轴 套 穿 过 机 喘 右 侧 板 ， 两 者 之 间 套 有 轴承 ， 这 样 可 以 保证 右前 摆 臂 相对 于 右前 主轴 和 机 喘 
右 侧 板 目 由 转动 ; 右前 摆 臂 电动 机 冉 定 在 机 号 右 侧 板 内 侧 ， 且 其 输出 轴 罕 过 右 侧 板 ， 右 前 摆 
臂 电动 机 通过 链 传动 带动 右前 摆 辟 张 动 链 轮转 动 ， 从 而 市 动 右前 摆 臂 杆 转动 ， 进 而 完成 机 痪 
人 右前 摆 臂 的 转动 : 右前 内 摆 臂 小 链 轮 和 右前 外 摆 展 小 链 轮 与 右前 行走 链 轮 外 径 相 同 ， 且 通 
过 键 连接 套 接 在 右前 主轴 外 端 ， 与 右前 主轴 同步 转动 ， 因 此 右前 内 摆 辟 小 链 轮 和 右前 外 摆 臂 
小 链 轮 可 市 动 右前 摆 避 履 市 与 右 行 走 履 这 保持 相同 的 线 速度 ， 石 前 摆 臂 驱动 猴 置 与 右前 摆 异 
履 市 组 成 右前 摆 臂 组件。 

所 述 左 后 摆 展 驳 动 朔 置 包 括 左 后 摆 辟 电动 机 、 左 后 摆 臂 驱动 链 轮 、 左 后 内 轴 僚 、 左 后 外 
轴 套 、 堪 后 摆 臂 杆 、 左 后 摆 臂 小 轴 、 磊 后 内 摆 臂 小 链 轮 、 堪 后 外 摆 臂 小 链 轮 、 左 后 内 摆 避 大 
链 轮 和 左 后 外 摆 臂 大 链 轮 : 左 后 摆 臂 大 链 轮 安 逆 在 无 后 摆 臂 杆 后 端的 左 后 摆 臂 小 轴 上 ;， 左 后 
内 轴 套 、 左 后 摆 辟 驱动 链 轮 、 左 后 外 轴 套 和 左 后 摆 臂 杆 依次 通过 螺栓 串 接 固 连 在 一 起 ， 并 通 
过 轴承 套 接 在 左 后 主轴 上 ， 其 中 左 后 内 轴 僚 穿 过 机 里 左 侧 板 ， 两 者 之 间 僚 有 和 轴承， 这 样 可 以 
你 证 左 后 摆 臂 相对 于 左 后 主轴 和 机 吴 左 侧 板 目 由 转动 ; 左 后 摊 禹 电动 机 固定 在 机 里 左 侧 板 内 
侧 ， 且 其 输出 轴 穿 过 左 侧 板 : 左 后 摆 臂 电动 机 通过 链 传动 寓 动 左 后 摆 彤 张 动 链 轮 转动 ， 从 而 
市 动 雹 后 摆 臂 杆 转动 ,进而 完成 机 器 人 堪 后 摆 臂 的 转动 ; 左 后 内 摆 臂 小 链 轮 和 左 后 外 摆 臂 小 
链 轮 与 左 后 内 行走 链 轮 外 径 相 同 , 且 通 过 键 连接 套 接 在 雹 后 主轴 外 奖 , 与 左 后 主轴 同步 转动 ， 
因此 远 后 内 摆 臂 小 链 轮 和 左 后 外 摆 辟 小 链 轮 可 市 动 元 后 摆 臂 履带 与 左 行 走 履 市 保持 相同 的 
线 速 度 ; 左 后 摊 句 驱动 疙 和 置 与 左 后 控 恬 履 沉 组 成 左 后 控 恬 组 件 。 所 述 右 后 控 恬 驱动 装置 包括 
右 后 控 辟 电动 机 、 右 后 摆 辟 驱动 链 轮 、 右 后 内 轴 套 、 右 后 外 轴 套 、 右 后 授 恬 村 、 石 后 摊 辟 小 
轴 、 右 后 内 摆 臂 小 链 轮 、 右 后 外 摆 臂 小 链 轮 、 右 后 内 摆 臂 大 链 轮 和 右 后 外 摆 臂 大 链 轮 ; 右 后 
摆 避 大 链 轮 安 冯 在 右 后 摆 臂 杆 后 端的 右 后 摆 臂 小 办 上 ; 右 后 内 轴 套 、 右 后 摆 辟 驱动 链 轮 、 石 
后 外 轴 套 和 右 后 摆 臂 杆 依次 通过 螺栓 绅 接 癌 连 在 一 起 ， 并 通过 轴承 套 接 在 右 后 主轴 上 ， 其 中 
右 后 内 轴 套 罕 过 机 身 右 侧 板 ,两 者 乙 间 套 有 轴承 ， 这 样 可 以 你 证 右 后 摆 臂 相对 于 右 后 主轴 和 
机 号 右 侧 板 目 由 转动 ; 右 后 摆 臂 电动 机 回 定 在 机 号 右 侧 板 内 侧 ， 且 其 输出 轴 穿 过 右 侧 板 ; 石 
后 摆 臂 电动 机 通过 链 传动 带动 右 后 摆 臂 驱动 链 轮 转动 ， 从 而 市 动 右 后 摆 代 杆 转动 ,进而 完成 
机 需 人 右 后 摆 辟 的 转动 ; 右 后 内 摆 臂 小 链 轮 和 右 后 外 摆 臂 小 链 轮 与 右 后 内 行走 链 轮 外 径 相 
同 ， 且 通过 键 连接 套 接 在 右 后 主轴 外 器 ， 与 右 后 主轴 同步 转动 ， 因 此 右 后 内 摆 民 小 链 轮 和 右 
后 外 摆 辟 小 链 轮 可 带动 右 后 摆 臂 履 市 与 右 行 走 履带 保持 相同 的 线 速 度 : 右 后 摆 避 张 动 装置 与 
石 后 控 恬 履带 组 成 右 后 控 锅 组件。 所 述 机 号 框 染 由 侧 板 、 基 板 、 连 接 板 及 履 市 深 轮 、 履 融 热 
块 组 成 。 两 块 侧 板 平行 布置 在 基板 两 侧 ， 四 块 连接 极 两 两 一 组 ,在 上 下 两 耐 将 平行 的 侧 板 和 
基板 连接 成 整体 ， 组 成 机 喘 框 染 ; 框 染 下 表面 的 连接 板 上 小 有 履 市 深 轮 ， 上 表面 的 连接 板 上 
米 有 履 囊 垫 块 , 通过 调整 履带 深 轮 和 履带 垫 块 相对 于 连接 板 的 垂下 位 置 ， 可 以 调节 行走 履带 
的 张 紧 程度 。 

所 述 机 身 框 架 包 括 左 侧 板 、 右 侧 板 、 基 板 、 上 前 连接 板 、 上 后 连接 板 、 下 前 连接 板 、 下 
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附录 


后 连接 板 及 履带 滚轮 和 履带 垫 块 。 左 侧 板 和 右 侧 板 平行 布置 在 基板 两 侧 ， 四 块 连接 板 两 两 一 
组 安装 在 框架 的 上 下 两 面 ， 将 平行 的 左 侧 板 、 右 侧 板 和 基板 连接 成 整体 ， 机 身 框 架 下 表面 的 
下 连接 板 上 装 有 履带 滚轮 ， 上 表面 的 上 连接 板 上 装 有 履带 垫 块 ， 通 过 调整 履带 深 轮 和 履带 垫 
块 在 连接 板 和 上 的 垂直 位 置 ， 可 以 调节 左 行走 履 融 和 右 行走 履 融 的 张 紧 程 度 。 

所 述 左 行走 张 动 电动 机 、 右 行走 驱动 电动 机 和 四 个 摆 臂 电动 机 在 基板 两 侧 采 用 了 非 对 称 
的 交错 布置 方式 ， 节 省 了 机 二 框架 内 的 空间 。 

所 述 左 行走 履 珊 和 右 行 走 履 市 在 帝 宽 方 问 采用 了 阶 棉 形 状 的 齿 形 ， 当 机 器 人 通过 松软 坎 
坷 路 面 时 ， 高 、 低 齿 面 均 可 接触 路 面 ， 提 高 了 其 通过 能 力 ， 当 机 器 人 在 硬 质 平坦 路 面 行走 时 ， 
只 有 高 齿 面 与 路 面 接触 ， 减 小 了 机 器 人 独 地 面积 ， 降 低 了 摩 控 阻力 ， 从 而 实现 了 机 堪 人 的 快 
速 、 高 效 行走 。 

本 发 明 的 有 益 效 末 为 : 机 器 人 的 同 地 面 都 被 履带 攻 辣 ， 使 得 机 器 人 在 通过 坎坷 崎 虹 地 面 
时 行走 自如 ， 克 服 了 传统 履带 式 移动 机 器 人 由 于 底 一 与 地 面 复 全 而 不 能 移动 的 缺点 ， 机 器 人 
前 后 共 装 有 四 条 可 以 自由 独立 摆动 的 捍 辟 ， 此 举 增强 了 机 器 人 的 灵活 性 和 柳 附 障碍 的 能 
通过 链 传动 及 电动 机 左右 交错 布 放 的 方式 节省 了 有 限 的 空间 ;行走 履带 采用 阶 樟 状 齿 形 ， 使 
得 机 器 人 可 以 在 不 同 质地 的 路 面 上 充分 发 挥 其 机 动能 

附 图 说 明 

附 图 D-1 为 小 型 六 履带 全 地 形 移动 机 器 人 整体 结构 示意 图 。 

附 图 D-2 为 小 型 六 履带 全 地 形 移动 机 器 人 左前 或 右前 摆 臂 驱动 装置 及 左 、 右 行走 驱动 装 
置 示意 图 。 

附 图 D-3 为 小 型 六 履带 全 地 形 移动 机 器 人 左 后 或 右 后 摆 臂 丝 动 钱 置 示意 疼 。 

附 图 D-4 为 小 型 六 履带 全 地 形 移动 机 器 人 左前 或 右前 摆 臂 丝 动 装置 轴 系 齐 视 图 。 

附 图 D-5 是 小 型 六 履带 全 地 形 移动 机 器 人 左 后 或 右 后 摆 臂 驱动 装置 轴 系 齐 视 图 。 

附 图 D-6 是 小 型 六 履带 全 地 形 移动 机 器 人 机 号 框架 结构 示意 图 。 

附 图 D-7 是 小 型 六 履带 全 地 形 移动 机 器 人 驱动 电动 机 交错 布 放 示 意图 。 

附 图 D-8 是 小 型 六 履 之 全 地 形 移动 机 器 人 阶梯 状 行走 履 禹 示意图。 

附 图 D-1 一 附 图 D- 8 中 ，1a 一 左前 摊 辟 内 大 链 轮 ; 1b 一 左前 摆 恬 外 大 链 轮 ;1c 一 右前 
捍 辟 内 大 链 轮 ，1d 一 右前 捍 辟 外 大 链 轮 ，1e 一 左 后 捍 辟 内 大 链 轮 ，1f 一 左 后 捍 辟 外 大 链 轮 ; 
1g 一 右 后 摆 臂 内 大 链 轮 ，1h 一 右 后 摆 臂 外 大 链 轮 ，2a 一 左前 摆 臂 内 小 链 轮 ;2b 一 左前 摆 臂 外 
小 链 轮 ;2c 一 右前 摆 臂 内 小 链 轮 ，2d 一 右 表 摆 臂 外 小 链 轮 ，2e 一 左 后 摆 臂 内 小 链 轮 ，2f 一 左 
后 摆 臂 外 小 链 轮 ，2g 一 右 后 摆 臂 内 小 链 轮 ，2h 一 右 后 摆 臂 外 小 链 轮 ;3a 一 左 行走 履带 ;3b 一 
右 行 走 履 带 ; 4a 一 左 侧 板 4b 一 右 侧 板 ; 5a 一 左前 摆 辟 履带 ; 5b 一 右前 捍 辟 履带 ;5c 一 左 后 
摆 臂 履带 ;5d 一 右 后 摆 臂 履带 ; 6a 一 左前 主轴 ; 6b 一 右前 主轴 ; 6c 一 左 后 主轴 ; 6d 一 右 后 主 
轴 ; 7a 一 左 大 天 办 ;7b 一 右 大 齿轮 ;8a 一 左前 内 行走 链 办 ;8b 一 左前 外 行走 链 轮 ;8c 一 右前 
内 行走 链 轮 ;8d 一 右前 外 行走 链 轮 ;，8e 一 左 后 内 行走 链 轮 ，8f 一 左 后 外 行走 链 轮 ，8g 一 右 后 
内 行走 链 轮 ，8h 一 右 后 外 行走 链 轮 ，9 一 基板 ;10a 一 左 行走 张 动 电动 机 :， 10b 一 右 行走 驱动 
电动 机 ，11a 一 左 行走 链 传动 系 ;，11b 一 右 行 走 链 传动 系 ，12a 一 左 小 齿轮 ，12b 一 右 小 齿轮 ; 
13a 一 左前 摆 臂 杆 ，13b 一 右前 摆 臂 杆 ，13c 一 左 后 摆 臂 杆 ，13d 一 右 后 押 臂 杆 ;，14a 一 左前 内 
轴 套 ; 14b 一 右前 内 轴 套 ;14c 一 左 后 内 轴 套 ;14d 一 右 后 内 轴 套 ; 1$a 一 左前 摆 臂 电动 机 
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15b 一 右前 捍 辟 电动 机 ; 15c 一 左 后 捍 辟 电动 机 ;15d 一 右 后 捍 辟 电动 机 ;16a 一 左前 摆 句 驱动 
链 轮 ，16b 一 右前 摆 臂 丝 动 链 轮 ，16c 一 左 后 摆 臂 驱动 链 轮 ，16d 一 右 后 摆 臂 驱动 链 轮 ，17a 一 
左前 外 轴 套 ; 17b 一 右前 外 轴 僚 ; 17c 一 左 后 外 轴 僚 ; 17d 一 右 后 外 轴 人 套 ; 18a 一 左前 摆 臂 小 轴 ; 
18b 一 右前 摆 臂 小 轴 ; 18c 一 左 后 摆 辟 小 轴 ; 18d 一 右 后 捍 辟 小 轴 ; 19a 一 上 前 连接 板 ;，19b 一 
上 后 连接 板 ; 19c 一 下 前 连接 板 ; 19d 一 下 后 连接 板 ; 20 一 履带 垫 块 ， 21 一 履带 深 轮 ，22 一 承 
载 平台 ; 23a 一 左 小 轴 ; 23b 一 右 小 轴 ; 24a 一 左前 摆 臂 马 动 装置 ，24b 一 右前 摆 臂 驱动 装置 ; 
24c 一 左 后 摊 辟 驱动 装置 ，24d 一 石 后 摊 辟 驱动 装置 ，254 一 左 行 走 驱 动 装置 ，25b 一 右 行 走 驱 
动 装 置 。 

具体 实施 方式 

下 面 结合 附 图 D-1 一 附 图 D-8 对 本 发 明 作 进一步 说 明 。 

如 附 图 D-1 所 示 ， 本 发 明 是 一 种 小 型 六 履带 全 地 形 移动 机 器 人 ,包括 两 套 行 走 张 动 猴 
置 、 四 套 摆 臂 组 件 及 机 喘 框 如 。 机 器 人 堪 行 走 履 带 3a 与 右 行走 履带 3b 左右 对 称 布置 ， 用 
盖 了 机 器 人 机 喘 框 架 的 上 上、 下、 前 、 后 表面 ， 张 动 电动 机 、 欣 制 系统 及 动力 电源 都 包含 在 
伞 左 行走 履带 3a 和 石 行走 履带 3b 履 兰 的 机 喘 框 以 内 : 左前 摆 臂 继 动 装置 24a 和 右 六 摆 辟 
驱动 装置 24b 安装 在 机 器 人 前 端 左 右 两 侧 , 左 后 摆 臂 驱动 装置 24c 和 右 后 摆 臂 驱动 装置 24d 
安装 在 机 器 人 后 端 左右 两 侧 ， 左 行走 驱动 装置 和 右 行走 张 动 逆 置 都 位 于 左前 摆 臂 驱动 装置 
24a 和 右前 摆 臂 丝 动 钱 置 24b 的 内 侧 : 左前 摆 臂 履带 Sa、 左 后 摆 臂 履带 5c 与 左 行走 履带 
3a 的 线 速度 相同 ,右前 摆 臂 履 市 Sb、 右 后 摆 辟 履带 5d 与 右 行 走 履 融 3b 的 线 速 度 相 同 ， 在 
翻越 隐 人 得 时 ， 四 个 摆 臂 可 以 起 到 文 撑 、 人 攀附 的 作用 ;机 器 人 上 部 还 装 有 承载 平台 22， 可 用 
于 安 猜 各 种 设备 附件 。 

如 附 图 D-2 所 示 ， 所 述 左 行走 驱动 装置 25a 包括 左 行走 驱动 电动 机 10a、 左 行走 链 传 
动 系 11a， 左 小 齿轮 12a、 左 小 轴 23a、 左 大 齿轮 7a、 左 前 主轴 、 左 前 内 行走 链 轮 8a、 左 六 
外 行走 链 轮 8b 和 左 行走 履带 。 左 行走 驱动 电动 机 10a 固定 在 机 吴 左 侧 板 4a 内 侧 ， 且 其 输 
出 轴 罕 过 左 侧 板 4a; 左 行走 链 传 动 系 11a 将 电动 机 转动 传递 给 固定 在 左 小 轴 23a 上 的 左 小 
齿轮 12a， 左 小 齿轮 12a 再 将 转动 传递 给 固定 在 左前 主轴 上 左前 内 行走 链 轮 8a、 左 前 外 行 
走 链 轮 8b 中 间 的 左 大 齿轮 7a， 从 而 带动 左前 内 行走 链 轮 8a 和 左前 外 行走 链 轮 8b 转动 ; 
左前 内 行走 链 轮 8a 和 左前 外 行走 链 轮 8b 与 左 行 走 履带 内 侧 的 链条 哮 合 ， 带 动 履带 转动 ， 
实现 机 器 人 的 行走 功能 。 所 述 右 行走 驱动 装置 25b 包括 右 行 走 驱 动 电 动机 10b、 右 行走 链 
传动 系 11b， 石 小 齿轮 12b、 石 小 轴 、 右 大 齿轮 7b、 右 前 主办、 右前 内 行走 链 轮 8b、 石 前 
外 行走 链 轮 8b 和 石 行走 履带 。 石 行走 驱动 电动 机 10b 固定 在 机 身 右 侧 板 4b 内 侧 ， 且 其 输 
出 轴 罕 过 右 侧 板 4b; 右 行 走 链 传动 系 11b 将 电动 机 转动 传递 给 固定 在 右 小 办 23b 上 的 右 小 
齿轮 12b， 右 小 齿轮 12b 再 将 转动 传递 给 固定 在 右前 主轴 上 右前 内 行走 链 轮 8c、 右 六 外行 
走 链 轮 8d 中 间 的 右 大 齿轮 7p， 从 而 带动 右前 内 行走 链 轮 8c 和 右前 外 行走 链 轮 8d 转动 ; 
右前 内 行走 链 轮 8c 和 右前 外 行走 链 轮 8d 与 右 行走 履带 内 侧 的 链条 嘴 合 ， 带 动 履带 转动 ， 
实现 机 器 人 的 行走 功能 。 

如 附 图 D-2、 附 图 D-4 所 示 ， 所 述 左 前 摆 臂 驱动 装置 包括 左前 摆 臂 电动 机 、 左 前 摆 臂 驱 
动 链 轮 16a、 左 前 内 轴 套 14a、 左 前 外 轴 套 、 左 前 摆 臂 杆 13a、 左 前 摆 臂 小 轴 18a、 左 前 内 摆 臂 
小 链 轮 2a、 左 前 外 摆 臂 小 链 轮 2b、 左 前 内 摆 臂 大 链 轮 1a 和 左前 外 摆 辟 大 链 轮 1b; 左前 摆 臂 
大 链 轮 1a 安装 在 左前 摆 臂 杆 13a 前 端的 左前 摆 臂 小 轴 上 ;左前 内 轴 套 14a、 左 前 摆 臂 驱动 链 
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附录 





轮 16a、 左 前 外 轴 套 17a 和 左前 摆 臂 杆 13a 依次 通过 螺栓 串 接 回 连 在 一 起 ， 并 通过 轴承 套 接 在 
左前 主轴 6a 上 ， 其 中 左前 内 轴 套 14a 罕 过 机 身 左 侧 板 4a， 两 者 之 间 套 有 轴承 ， 这 样 可 以 保证 
左前 捍 辟 相对 于 左前 主轴 6a 和 机 身 左 侧 板 4a 自由 转动 ; 左前 摆 臂 电动 机 15a 固定 在 机 号 左 侧 
板 4a 内 侧 ， 且 其 输出 轴 穿 过 左 侧 板 4a; 左前 摆 臂 电动 机 15a 通过 链 传动 带动 左前 摆 臂 驱 动 链 
轮 16a 转动 ， 从 而 带动 左前 摆 臂 杆 13a 转动 ， 进 而 完成 机 帮 人 左前 择 恬 的 转动 : 左前 内 摆 臂 小 
链 轮 2a 和 左前 外 捍 辟 小 链 轮 2b 与 左前 内 行走 链 轮 8a 外 径 相 同 ， 且 通过 键 连接 套 接 在 左前 主 
轴 6a 外 端 ， 与 左前 主轴 6a 同步 转动 ， 因此 左前 内 摆 臂 小 链 轮 2a 和 左 表 外 摆 臂 小 链 轮 2b 可 带 
动 左前 摆 臂 履带 与 左 行走 履带 保持 相同 的 线 速 度 ， 左 前 摆 臂 驱动 朔 置 与 左 六 摆 臂 履带 组 成 左 
前 摆 臂 组 件 。 所 述 右前 摆 臂 驱动 装置 包括 右前 摆 臂 电动 机 1Sb、 右 前 摆 辟 驱动 链 轮 16b、 右 前 
内 轴 套 14b、 右 前 外 轴 套 17b， 右 前 捍 辟 杆 13b、 右 前 摆 辟 小 轴 18b、 右 前 内 摆 辟 小 链 轮 2c、 
右前 外 摆 臂 小 链 轮 2d、 右 前 内 捍 辟 大 链 轮 lc 和 右前 外 摆 臂 大 链 轮 14、 右 前 摆 臂 大 链 轮 lb 安 
装 在 右前 捍 辟 杆 13b 前 端的 右前 摆 臂 小 轴 18b 上 ; 右前 内 轴 套 14b。、 右 前 摆 辟 驱动 链 轮 16b、 
右前 外 轴 套 17b 和 右前 摆 臂 杆 13b 依次 通过 螺栓 串 接 固 连 在 一 起 ， 并 通过 轴承 套 接 在 右前 主 
轴 6b 上 ， 其 中 右前 内 轴 套 14b 穿 过 机 身 右 侧 板 4b， 两 者 之 间 套 有 轴承 ， 这 样 可 以 保证 右前 摆 
侣 相对 于 右前 主轴 6b 和 机 身 右 侧 板 4b 目 由 转动 ; 右前 摆 臂 电动 机 15b 固定 在 机 号 右 侧 板 4b 
内 侧 , 且 其 输出 轴 罕 过 右 侧 板 4b; 右前 摆 臂 电动 机 15b 通过 链 传动 融 动 右 表 把 辟 张 动 链 轮 16b 
转动 ， 从 而 带动 右前 摆 臂 杆 13b 转动 ， 进 而 完成 机 器 人 右前 摆 臂 的 转动 ; 右前 内 摆 臂 小 链 轮 
2c 和 右前 外 摆 臂 小 链 轮 2d 与 右前 行走 链 轮 8b 外 径 相 同 ， 且 通过 键 连 接 套 接 在 右前 主轴 6b 外 
问 ， 与 右前 主轴 6b 同步 转动 ， 因 此 右前 内 摊 辟 小 链 轮 2c 和 右前 外 摆 辟 小 链 轮 2d 可 带动 右前 
摆 臂 履带 与 右 行走 履带 保持 相同 的 线 速度 ; 右前 捍 辟 驱动 装置 与 右前 摆 辟 履 帝 组 成 右前 捍 辟 
组 件 。 

如 附 图 D-3、 附 图 D-5 所 示 ， 所 述 左 后 摆 辟 驱动 冯 置 24c 包括 左 后 摆 臂 电动 机 15c、 
左 后 摆 臂 驱动 链 轮 16c、 左 后 内 轴 套 14c、 左 后 外 轴 套 17c、 左 后 摆 臂 杆 13c、 左 后 摆 臂 小 
轴 18c、 左 后 内 摆 臂 小 链 轮 2e、 左 后 外 摆 臂 小 链 轮 2f、 左 后 内 摆 臂 大 链 轮 le 和 左 后 外 摆 
侣 大 链 轮 1f; 左 后 摆 臂 大 链 轮 le 安 闭 在 左 后 摆 臂 杆 13c 后 问 的 左 后 摆 臂 小 轴 18c 上 ; 左 
后 内 轴 套 14c、 左 后 摆 臂 驱动 链 轮 16c、 左 后 外 轴 套 17c 和 左 后 摆 臂 杆 13c 依次 通过 螺栓 
串 接 固 连 在 一 起 ， 并 通过 轴承 套 接 在 左 后 主轴 6c 上 ， 其 中 左 后 内 轴 套 14c 军 过 机 吴 左 侧 
板 ， 两 者 之 间 套 有 轴承 ， 这 样 可 以 保证 左 后 捍 臂 相对 于 左 后 主轴 6c 和 机 喘 左 侧 板 自 由 转 
动 ; 左 后 摆 臂 电动 机 。 固 定 在 机 喘 左 侧 板 内 侧 ， 且 其 输出 轴 罕 过 左 侧 板 ; 左 后 摆 臂 电动 机 
15c 通过 链 传动 带动 左 后 摆 臂 驱动 链 轮 16c 转动 ， 从 而 带动 左 后 摆 臂 杆 13c 转动 ， 进 而 完 
成 机 器 人 左 后 摆 臂 的 转动 ; 左 后 内 摆 臂 小 链 轮 2e 和 左 后 外 摆 臂 小 链 轮 2f 与 左 后 内 行走 链 
轮 8e 外 径 相 同 ， 且 通过 键 连接 套 接 在 左 后 主轴 6c 外 端 ， 与 左 后 主轴 6c 同步 转动 ， 因 此 
左 后 内 摆 臂 小 链 轮 2e 和 左 后 外 摆 臂 小 链 轮 2f 可 带动 左 后 摆 臂 履带 与 左 行走 履带 保持 相同 
的 线 速度 ; 左 后 摆 恬 驱动 装置 24c 与 左 后 摆 臂 履带 组 成 左 后 摆 臂 组 件 。 所 述 右 后 摆 臂 驱动 
闭 置 24d 包括 右 后 摆 臂 电动 机 1$Sd、 右 后 摆 臂 驱动 链 轮 16d、 石 后 内 轴 套 14d、 石 后 外 轴 
套 17d， 右 后 捍 臂 杆 13d4、 右 后 摆 臂 小 轴 18d、 右 后 内 摆 臂 小 链 轮 2g、 右 后 外 摆 臂 小 链 轮 
2h、 右 后 内 摆 臂 大 链 轮 1g 和 右 后 外 摆 臂 大 链 轮 1h; 右 后 摆 臂 大 链 轮 安 闭 在 右 后 摆 臂 杆 13d 
后 端的 右 后 摆 臂 小 轴 上 ; 右 后 内 轴 套 14d、 右 后 摆 臂 驱动 链 轮 16d4、 右 后 外 轴 套 17d 和 碳 
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后 摆 臂 杆 13d 依次 通过 螺栓 串 接 固 连 在 一 起 ， 并 通过 轴承 套 接 在 右 后 主轴 6d 上 ， 其 中 碳 
后 内 轴 套 14d 穿 过 机 号 右 侧 板 ， 两 者 之 间 套 有 轴承 , 这样 可 以 保证 右 后 摆 臂 相对 于 右 后 主 
轴 6d 和 机 身 右 侧 板 自 由 转动 ; 右 后 摆 臂 电动 机 15d 固定 在 机 吴 右 侧 板 内 侧 ， 且 其 输出 轴 
穿 过 右 侧 板 ; 右 后 摆 臂 电动 机 15d 通过 链 传 动 带动 右 后 摆 臂 驱动 链 轮 16d 转动 ， 从 而 带动 
右 后 摆 臂 杆 13d 转动 ， 进 而 完成 机 器 人 右 后 摆 臂 的 转动 : 右 后 内 摆 臂 小 链 轮 2g 和 右 后 外 
摆 臂 小 链 轮 2h 与 右 后 内 行走 链 轮 8g 外 径 相 同 ， 且 通过 键 连接 套 接 在 右 后 主轴 6d 外 端 ， 
与 右 后 主轴 6d 同步 转动 ， 因 此 右 后 内 摆 臂 小 链 轮 2g 和 右 后 外 摆 臂 小 链 轮 2h 可 带动 右 后 
摆 臂 履 融 与 右 行走 履带 3b 保持 相同 的 线 速 度 ; 右 后 摆 臂 驱动 装置 24d 与 右 后 摆 臂 履带 组 
成 右 后 摆 臂 组 件 。 

如 附 图 D-3、 附 图 D-5 所 示 ， 所 述 左 后 内 行走 链 轮 8e 和 左 后 外 行走 链 轮 8f 并 排 固定 在 
左 后 主轴 6c 上 ， 并 与 左 行 走 履带 内 侧 的 链条 嘴 合 ， 右 后 内 行走 链 轮 8g 和 右 后 外 行走 链 轮 8h 
并 排 固定 在 右 后 主轴 6d 上 ， 并 与 右 行走 履带 内 侧 的 链条 路 合 。 

如 附 图 D-6 所 示 , 所 述 机 喘 框 架 包 括 左 侧 板 4a、 右 侧 板 4b、 基板 9、 上 前 连接 板 19a。 
后 连接 板 19b、 下 前 连接 板 19c、 下 后 连接 板 19d 及 履带 滚轮 21 和 履带 垫 块 20。 左 侧 板 
4a 和 右 侧 板 4b 平行 布置 在 基板 9 两 侧 , 四 块 连接 板 两 两 一 组 安装 在 框 染 的 上 下 两 面 , 将 
平行 的 左 侧 板 4a、 右 侧 板 4b 和 基板 9 连接 成 整体 ; 机 和 映 框架 下 表面 的 下 连接 板 19b 上 闭 
有 履带 滚轮 21， 上 表面 的 上 连接 板 19a 上 装 有 履带 垫 块 20， 通 过 调整 履带 滚轮 21 和 履 
带 热 块 20 在 连接 板 19a 和 19b 上 的 垂直 位 置 ， 可 以 调节 左 行 走 履 带 和 右 行走 履带 的 张 紧 
程度 。 

如 附 图 D-7 所 示 ， 所 述 左 行走 驱动 电动 机 10a、 碳 行走 驱动 电动 机 10b 和 四 个 摆 臂 电动 
机 1$a，1S$b，1S$c 及 15d 在 基板 9 两 侧 采 用 了 非 对 称 的 交错 布 置 方式 ， 节 省 了 机 号 框架 内 的 
3 国有 

如 附 图 D-8 所 示 ， 所 述 左 行走 履带 3a 和 右 行 走 履 带 3b 在 带 澳 方 回采 用 了 阶梯 形状 的 齿 
形 ， 当 机 器 人 通过 松软 坎坷 路 面 时 ， 高 、 低 齿 面 均 可 接触 路 面 ， 提 高 了 其 通过 能 力 ， 当 机 器 
人 在 硬 质 平坦 路 面 行走 时 ， 上 只 有 高 齿 面 与 路 面 接触 ， 减 小 了 机 器 人 着地 面积 、 降 低 了 摩 探 阻 
力 ， 从 而 实现 了 机 器 人 的 快速 、 高 效 行 走 。 
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附 图 D-1 小 型 六 履 融 全 地 形 移 动机 器 人 整体 结构 示意 网 
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附 图 D-2 小 型 六 履 市 全 地 形 移动 机 融 人 左前 或 右前 摆 辟 驱动 装置 及 左 、 石 行走 驱动 装置 示 总 图 
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附 图 D-3 小 型 六 履 融 全 地 形 移动 机 器 人 左 后 或 右 后 摆 辟 驱动 装置 示意 图 
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附 图 D-4 小 型 六 履 训 全 地 形 移动 机 器 人 左前 或 右前 摆 辟 张 动 朔 置 轴 系 剖 视 图 
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附 图 D-5 小 型 六 履 训 全 地 形 移动 机 器 人 左 后 或 右 后 摆 辟 张 动 逆 置 轴 系 痢 视 图 
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附 图 D-6 ”小 型 六 履带 全 地 形 移 动机 帮 人 机 身 框 染 结 构 示意 图 
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附 图 D-7 小 型 六 履 计 全 地 形 移 动机 器 人 驱动 电动 机 交错 布 放 示 意 立 








附 图 D-8 小 型 六 履 计 全 地 形 移动 机 器 人 阶 柳 状 行走 履 市 示意 图 
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仿生 多 关 太 型 机 器 人 腿 部 驱动 传动 六 转 专利 


专利 名 称 : 仿生 多 关节 型 机 避 人 腿 部 驱动 传动 装置 
发 明 人 : 韩 宇 玲 ; 罗 庆 生 ; 人 徐 胆 ; 潘 登 ， 王 辉 


仿生 多 天 节 型 机 器 人 服部 驱动 传动 于 置 





技术 领域 

本 发 明 属 于 仿生 机 右 人 技术 领域 ， 具 体 涉 及 一 种 仿生 六 足 多 关节 型 机 喜人 的 腿 部 张 动 传 
动 北 旱 。 

育 景 技术 

由 于 轮 陈 张 动车 辆 本 身 在 结构 特性 和 运动 方式 上 的 局 限 性 ， 使 其 很 难 在 路 面 师 虹 或 条 件 
恶 盆 的 环境 下 高 效 运动 ， 而 多 足 步 行 机 器 人 只 有 极 好 的 复杂 地 形 适 应 能 力 ， 使 乙 能 在 非 规则 
路 面 上 稳定 行走 ， 因 此 仿生 多 足 步 行 机 问 人 在 许多 行业 有 痢 广 阔 的 应 用 前 景 。 

腿 机 构 是 多 是 步行 机 占 人 实现 融 效 行走 的 关键 组 件 。 目 前 常见 的 腿 机 构 有 四 杆 机 构 式 、 
顷 放 式 、 伸 缩 式 及 关 市 式 等 。 关 市 式 腿 机 构 的 优点 在 于 结构 紧 竣 、 控 制 人 简单 、 运 动 姑 活 。 此 
外 ， 由 于 关节 式 腿 机 构 采 用 的 是 纯 转 动 关 节 组 合 的 形式 ， 足 端 可 达 域 比较 大 ， 在 机 号 失 稳 状 
态 下 具有 较 强 的 姿态 恢复 能 力 。 对 于 灵 巧 型 多 用 途 步 行 机 需 人 而 言 ， 关 节 陈 腿 机 构 更 符合 其 
在 不 同 路 面 条 件 下 实际 运动 的 需要 。 

发 明 内 容 

本 发 明 的 目的 在 于 提供 一 种 仿生 六 足 多 关节 型 机 喜人 的 腿 部 驱动 传动 装置 ， 该 装置 采用 
开 链 机 构 ， 凄 置 上 的 每 个 关节 都 能 单独 控制 ， 上 只 有 承载 力 大 、 可 达 域 广 、 结 构 紧 次、 控制 傈 
单 、 步 态 稳定 、 运 动 灵活 等 特点 ， 并 且 具 有 较 好 的 条 性 。 

为 了 实现 上 述 发 明 目 的， 一 种 多 关节 型 机 右 人 腿 部 驱动 传动 疙 置 基 市 组 件 、 肥 节 组 件 和 
股 节 组 件 构 成 。 其 特征 在 于 基 市 组 件 包括 座 套 、 电 动机 合 件 、 上 闹 产 、 电 动机 套 及 大 弧 此 锥 
齿轮 《该 齿轮 固定 在 电动 机 套 的 文 臂 内 侧 ) 等 零 部 件 。 其 中 ， 座 套 通 过 螺 杀 与 机 右 人 本 体 回 
连 ， 且 其 上 下 羡 两 准 直 通 筷 内 各 目 馈 骨 一 个 轴承 ， 电 动机 合 件 插入 这 两 个 轴承 的 内 座 疾 中 以 
实现 周 向 固定 ;上 闯 盖 利用 其 上 的 异形 了 筷 套 在 电动 机 合 件 的 输出 轴 上 实现 成 形 连 接 ， 并 用 蝶 
钉 将 上 站 副 问 定 在 座 套 上 ， 使 上 器 瘟 和 电动 机 合 件 的 输出 轴 及 座 套 成 为 问 连 体 ， 在 电动 机 合 
件 上 竣 有 一 个 电动 机 套 ， 用 螺 杀 把 电动 机 套 与 电动 机 合 件 锁 死 ， 使 电动 机 套 和 电动 机 合 件 成 
为 固 连 体 ， 这 样 当 电动 机 驱动 时 ， 因 电动 机 合 件 输出 轴 已 通过 上 端 盖 和 座 套 与 机 各 人 本 体形 
成 回 连 ， 该 输出 轴 不 能 产生 旋转 运动 ， 根 据 “相对 运动 不 变性 ”原理 ， 这 时 电动 机 合 件 本 体 
将 读 动 电动 机 套 《〈 连 同 腔 节 组 件 中 的 大 文 架 ) 一 并 绕 电 动机 输出 轴 旋 转 。 念 生 六 是 机 右 人 的 
摊 腿 动作 束 古 依 罪 上 述 传 动 来 完成 的 。 肥 节 组 件 包括 大 文 染 、 电 动机 合 件 、 小 弧 齿 锥 齿轮 和 
大 弧 次 锥 齿轮 ， 大 文 染 内 固定 有 电动 机 合 件 ， 小 弧 齿 锥 雁 轮 安 状 在 电动 机 合 件 的 输出 轴 上 ， 
并 与 固定 在 电动 机 套 文 避 内 侧 的 大 弧 齿 锥 齿轮 哮 合 ， 因 大 弧 次 锥 齿轮 已 与 电动 机 套 固 连 而 不 
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能 旋转 ， 所 以 电动 机 合 件 的 输出 运动 将 成 为 大 支 染 连同 其 上 的 电动 机 合 件 和 小 弧 齿 锥 齿轮 统 
电动 机 人 套 文 辟 远 闹 处 大 弧 齿 锥 齿轮 轴线 的 转动 。 股 节 组 件 包括 小 支架 、 电 动机 合 件 、 小 弧 齿 
锥 齿轮 、 两 个 深 沟 球 轴承 和 足 套 。 小 文 架 内 固定 有 一 电动 机 合 件 ， 小 弧 齿 锥 齿轮 安 站 在 电动 
机 合 件 的 输出 轴 上 ， 并 与 固定 在 大 文 染 远 并 文 辟 内 侧 的 大 弧 郑 锥 齿轮 哮 合 ， 因 大 弧 齿 锥 齿轮 
已 与 大 文 染 固 连 而 不 能 旋转 ， 所 以 电动 机 合 件 的 输出 运动 将 成 为 小 文 架 连同 其 上 的 电动 机 合 
件 、 小 弧 齿 锥 郑 轮 和 是 僚 绕 大 文 染 远 并 文 辟 处 大 弧 齿 锥 齿轮 轴线 的 转动 。 足 套 连 接 在 小 文 染 
的 下 痕 。 仿 生 六 足 机 器 人 的 抬 腿 动作 就 是 靠 肥 和 组 件 和 股 世 组件 的 上 述 转动 来 完成 的 。 

上 述 结构 中 ， 所 述 的 电动 机 合 件 包括 编码 器 、 和 直流 无 刷 伺 服 电 动机 和 齿轮 减速 器 。 

上 述 结构 中 ， 所 述 的 小 弧 齿 锥 齿轮 和 大 弧 齿 锥 齿轮 ， 其 特征 在 于 弧 齿 锥 齿轮 传动 副 齿 面 
应 力 小 ， 承 载 能 力 强 ， 工 作 平稳 ， 对 安装 误差 和 变形 不 敏感 ， 且 轴 癌 力 与 旋回 无 关 。 

本 发 明 的 优点 在 于 : 

1) 驱动 电动 机 及 传动 部 件 都 汇 在 腿 的 内 部 ， 布 局 合理 、 设 计 精 妙 、 体 积 小 巧 、 结 构 坚 凑 ， 
既 减 少 了 衬 间 占用 率 ， 还 有 利于 电动 机 走 线 。 

2) 各 关节 的 运动 范围 和 回转 角度 很 大 ， 根 关节 的 摆动 角度 可 达 180"， 大 腿 可 经 其 天 攻 翻 
转 150°*， 小 腿 可 绕 其 关 市 翻转 300?。 

3) 传动 机 构 采 用 圆 踊 此 锥 齿轮 运动 副 ， 比 直 丙 锥 齿轮 的 应 力 分 布 和 受 力 状况 改善 很 多 ， 
运转 平稳 ， 噪 声 低 ， 振 动 小 ， 使 用 寿命 长 。 

附 图 说 明 

附 图 E-1 为 仿生 六 中 多 天 下 型 机 器 人 的 整体 布局 。 

附 图 E-2a 为 机 器 人 腿 部 结构 示意 图 ， 图 E-2b 为 基 东 组 件 齐 视 岁 。 

附 图 E-3 为 机 右 人 腿 部 机 构 示 意图 的 俯视 网 。 

附 图 E-1 一 附 图 E-3 中 ，1 一 本 体 ; 2 一 腿 部 装置 ，3 一 座 套 ; 4 一 电动 机 套 ; 5 一 电动 机 合 
件 ，6 一 上 病 新 ，7 一 大 文 架 ; 8 一 小 文 架 ; 9 一 足 套 ; 10 一 连接 轴 ; 11 一 大 弧 雌 锥 齿轮 ，12 一 小 


路 齿 锥 齿轮 。 
具体 实施 方式 


如 附 图 E-1 所 示 , 仿生 六 足 多 关 市 型 机 右 人 包括 本 体 1 和 腿 部 装置 2， 其 六 个 相同 的 腿 部 
装置 2 并 列 分 布 在 本 体 1 的 左右 两 边 ， 每 个 腿 部 准 置 部 拥有 附 图 E-2 (或 附 图 E-3) 所 示 的 一 
套 驱 动 传动 装置 。 

如 附 图 E-2a 所 示 ， 腿 部 驱动 传动 装置 由 基 节 组 件 、 肥 节 组 件 和 股 节 组 件 构 成 。 如 附 图 E-2b 
所 示 ， 基 市 组 件 包括 座 僚 3、 电 动机 套 4、 电 动机 合 件 5 和 上 站 兰 6 及 大 弧 具 锥 齿轮 ; 座 套 3 上 下 
站 两 准 百 通 孔 内 各 日 贸 骨 轴 藉 ， 电 动机 合 件 5 插入 这 两 个 轴 藉 的 内 座 罗 中 ;上 站 兰 6 利用 其 上 的 
异形 孔 套 在 电动 机 合 件 5 的 得 出 轴 上 实现 成 形 连 接 ， 并 用 曙 杀 将 上 闯关 6 固定 在 座 套 3 上， 电动 
机 合 件 5 上 崇 固 有 电机 套 4， 由 于 电动 机 合 件 输 出 轴 己 通过 上 端 音 6 和 座 套 3 与 机 各 人 本 体形 成 
问 连 ， 当 电动 机 驱动 时 ， 电 动机 合 件 本 体 将 带动 电动 机 套 4 和 上 肥 市 组 件 中 的 大 文 染 7 一 并 绕 电 动 
机 输出 轴 旋 转 。 如 附 图 E-2a 和 附 图 E-3 所 示 ， 胜 市 组 件 包括 大 支架 7， 大 文 染 7 内 固定 有 电动 机 
合 件 5， 小 弧 上 郑 锥 认 轮 12 安 闪 在 电动 机 合 件 5 的 输出 轴 上 ; 股市 组 件 包括 小 支 染 8， 小 文 染 8 内 
问 定 有 电动 机 合 件 5， 小 弧 齿 锥 齿轮 12 安装 在 电动 机 合 件 5 的 输出 轴 上 ， 足 套 9 连接 在 小 文江 8 
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附录 


的 下 端 。 基 节 组 件 与 关节 组 件 之 间 是 用 大 弧 齿 锥 齿轮 11 和 连接 轴 10 相连 ， 大 弧 具 锥 具 轮 11 和 连 
接 轴 10 是 用 螺钉 固定 在 电动 机 套 4 上 的 ， 肥 节 组 件 与 股 节 组 件 之 间 也 是 用 大 弧 齿 欠 齿 轮 11 和 连 
接 轴 10 相连 ， 大 弧 齿 锥 齿轮 11 和 连接 轴 10 是 用 螺钉 固定 在 大 支架 7 下 端 

当 机 器 人 摆 腿 时 ， 基 节 组 件 中 电动 机 合 件 5 的 输出 轴 相 对 于 座 套 3 是 静止 的 , 而 转动 的 是 电 
动机 合 件 5 本 身 ， 电 动机 合 件 5 转动 时 带动 电动 机 套 4 在 水 平方 向 上 一 同 转动 ,与 电动 机 套 4 相 
连 的 肥 节 组 件 也 随 之 转动 。 当 机 器 人 抬 动 大 腿 时 ， 肥 节 组 件 中 的 电动 机 带动 小 弧 具 锥 齿轮 12 转 
动 ， 由 小 弧 齿 锥 上 内 轮 12 与 大 弧 具 锥 齿轮 11 的 路 合 运动 ， 使 得 整个 豚 节 组 件 可 以 在 垂直 方向 上 包 
连接 轴 10 的 中 心 为 圆心 转动 ， 当 机 器 人 抬 动 小 腿 时 ， 股 节 组 件 中 的 电动 机 带动 小 弧 齿 锥 齿轮 12 
转动 ， 由 小 弧 齿 锥 齿轮 12 与 大 弧 齿 锥 齿轮 11 的 咕 合 运动 ， 使 得 整个 股 节 组 件 可 以 在 垂直 方向 上 
以 连接 轴 10 的 中 心 为 圆心 转动 。 最 终 通过 对 三 个 电动 机 的 控制 来 完成 机 器 人 整个 腿 部 的 运作 。 

说 明 书 附 图 














附 图 E-1 仿生 六 足 多 关节 型 机 喜人 的 整体 布局 





a) b) 


附 图 E-2 机 器 人 腿 部 机 构 示意 图 
a) 腿 部 结构 示意 图 。b) 基 节 组 件 剖 视图 
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附 图 E-3 机 各 人 腿 部 机 构 示意 图 的 信 视 图 
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技术 领域 
本 发 明 涉及 一 种 适用 于 多 足 式 机 需 人 足 问 力 信号 探测 的 压力 传 感 问 ， 属 于 传 感 磊 技术 。 
育 景 技术 








为 了 更 好 地 调整 步行 机 器 人 行走 时 的 步 态 和 姿态 ， 多 足 式 机 器 人 往往 通过 足 端 压力 传 感 
央 获 取 地 面 信 息 ， 并 根据 这 些 信息 进行 实时 控制 。 目 前 ， 普 通 的 压力 传 感 匿 因 存 在 测量 范围 
宕 、 减 震 性 能 兰 、 易 村 损坏 、 价 格 昂 贯 等 缺点 ， 不 能 直接 移植 到 多 足 式 机 融 人 的 足 咒 ， 制 约 
了 多 足 却 机 堪 人 机 动 性 能 的 及 挥 。 

发 明 内 容 

本 发 明 的 目的 在 于 提供 一 种 适用 于 多 足 式 机 需 人 的 新 型 足 端 压 力 传 感 磺 。 该 传 感 右 具有 
体积 小 、 量 程 大 、 结 构 傈 单 、 功 能 可 牧 、 性 能 稳定 、 减 震 性 能 好 、 使 用 寿命 长 等 特点 。 

为 了 实现 上 述 肥 明 目 的 ， 该 传 感 融 包 括 足 中 触 力 机 械 传递 猴 置 、 信 和 号 转换 及 放大 装置 和 
ERF 电流 变 敏 感 材料 隅 振 北 置 。 

足 痛 触 力 机 械 传递 装置 是 由 上 弹 得 导 杆 、 下 弹 贰 导 杆 、 二 级 减 震 弹 著 、 圆 锥 文 撑 杆 、 垫 
板 和 垫圈 组 成 。 执 板 在 腿 部 简 套 的 凸 台 之 上 ， 通 过 螺栓 与 足 套 相连 接 ; 圆锥 文 撑 杆 通过 足 端 
螺杆 、 连 接 螺 杆 分 别 与 垂 生 力 转 换 装 置 和 下 弹 间 导 杆 相连 接 ， 连 接 暴 杆 冉 定 装置 用 于 冉 定 连 
接 螺 杆 ， 一 级 减 震 弹 千 被 回 定 在 足 套 与 腿 部 套 简 之 间 的 空间 和 内， 并 且 其 后 问 与 足 套 中 的 圆柱 
凸 台 相 接触 ， 一 级 减 震 弹 先 的 项 丧 与 腿 部 套 简 乙 间 垫 有 的 背 ， 达 到 一 级 减 震 的 目的 ， 上 弹 千 
导 杆 和 下 弹壳 导 杆 可 以 在 腿 部 套 简 中 上 下 滑动 ， 两 者 之 间 通 过 二 级 减 震 弹 蛙 传递 力 的 作用 ， 
以 达到 二 级 减 震 的 目的 ， 从 而 将 最 终 传 到 传 感 硕 上 的 力 限 制 在 规定 的 0 一 SN 光 围 之 内 。 信 与 
转换 及 放大 装置 是 固定 在 上 弹 黄 导 杆 和 腿 部 套 简 的 凸 人 台 之 间 ，EREF 电流 变 敏 感 材 料 上 部 与 机 
骼 人 腿 部 相连 搁 ， 下 部 与 信号 转换 与 放大 模块 相 接 触 。 足 冰 为 橡胶 材料 ， 套 在 腿 部 套 简 的 下 
部 。 足 套 与 足 端 通过 螺纹 相连 。 和 对 直 力 转换 装置 为 铝 制 材料 。 

信号 转换 及 放大 装置 包括 供电 模块 、 信 和 号 测量 转换 模块 和 信号 放大 模块 。 供 电 梗 块 采 用 
恒 流 源 供 电 ， 有 效 消除 了 温度 变化 的 影响 。 信 号 训 量 转换 模 其 采用 由 单 品 硅 制 成 的 压 敏 电阻 
所 构成 的 电 桥 。 单 品 硅 具 有 工作 可 笔 、 耐 腐蚀 、 抗 干扰 能 力 强 等 特点 。 当 上 压力 经 足 疹 触 力 机 
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械 传递 装置 传 到 信号 测量 转换 模块 时 ， 弹 性 腊 片 束 会 产生 形变 ， 形 成 正 、 负 两 个 应 变 区 ， 同 
时 压 敏 电阻 的 电阻 率 也 发 生 相 应 的 变化 ， 引 起 电 桥 不 平衡 ， 产 生 一 个 与 压力 成 正比 的 电流 信 
号 。 信 和 号 放大 模块 具有 高 阻抗 ， 有 效 避 免 了 从 信号 测量 转换 模块 的 输出 端 吸 收 电流 ， 在 不 破 
坏 信 号 测量 转换 模 工 作 状 态 的 情况 下 ， 将 输出 信号 放大 。 

减 震 装置 采用 ERF 电流 变 敏 感 材料 ,该 材料 可 以 在 液态 和 固态 属性 之 间 快 速 转变 ， 响应 时 间 
为 ms 量 级 ;该 转变 可 以 使 用 简单 的 电场 信号 控制 ， 探 制 材料 消耗 的 能 量 极 低 ， 该 转变 随 电 场 强 
度 连 续 无 级 变换 ， 而 且 是 完全 可 逆 的 ;转变 体系 不 存在 机 械 构件 间 的 相对 运动 ， 其 有 无 磨损 、 工 
作 状 态 柔 和 、 噪 声 低 、 寿 命 长 等 特点 。 信 和 号 转换 及 放大 装置 的 得 出 信号 传递 到 ERF 电流 变 敏 感 材 
料 减 震 装 置 ，ERF 智能 材料 一 随 电 信号 的 强 弱 改变 状态 ， 从 而 收 到 实时 、 自 适应 减 震 的 效果 。 

本 发 明 的 优点 有 : 传感器 的 机 械 传 动 装置 通过 二 级 减 震 ， 可 将 机 器 人 足 端 较 大 的 触 力 
线性 地 缩减 到 力 敏 电阻 的 正 利 感 测 范 围 内 ， 增 大 了 传 感 喜 的 量程 ; 包 信 号 转换 及 放大 电路 具 
有 工作 可 靠 、 耐 腐蚀 、 抗 干扰 能 力 强 、 不 受 温度 影响 等 特点 ，(B) 减 震 北 置 采 用 RRF 电流 变 敏 
感 材料 ， 能 够 随 电 信号 的 强 弱 改变 状态 ， 从 而 收 到 实时 、 目 适应 减 震 的 效 末 ; 外 该 压力 传 感 
器 采用 模块 化 设计 ， 结 构 简 单 、 功 能 可 笔 ， 可 广泛 应 用 于 各 种 多 足 式 机 器 人 。 

附 图 说 明 

附 图 F-1 为 多 足 式 机 器 人 足 端 压力 传 感 右 的 整体 结构 示意 网。 

附 图 F-2 为 信号 转换 及 放大 装置 的 电路 图 。 

附 图 F-1 和 附 图 F-2 中 ，1 一 信号 转换 及 放大 闭 置 ;2 一 上 弹 车 导 杆 ;3 一 螺栓 ;4 一 下 弹 
早 导 杆 ，5 一 腿 部 套 简 ; 6 一 垫 板 ;7 一 昔 圈 ; 8 一 足 套 ;9 一 二 级 减 震 弹 和 敬 ，10 一 一 级 减 震 弹 竹 ; 
11 一 圆锥 支撑 杆 ，12 一 垂直 力 转 换 装 置 ，13 一 ERF 电流 变 敏感 材料 ，14 一 电 桥 ;15 一 信号 放 
大 模块 ;16 一 供电 模块 ;， 17 一 足 端 螺杆 18 一 连接 螺杆 ; 19 一 连接 螺杆 固定 装置 ，20 一 机 器 
人 腿 部 ，21 一 足 端 。 

具体 实施 方式 

下 面 结合 附 图 F-1 和 附 图 F-2 对 本 发 明 作 进 一 步 说 明 。 

如 附 图 F-1 所 示 ， 多 足 陈 机 堪 人 足 问 触 力 机 械 传递 装置 是 由 上 弹 营 导 杆 2、 下 弹 赞 导 
杆 4、 二 级 减 震 弹 短 9、 圆锥 文 撑 杆 11、 热 板 6 和 垫圈 7 组 成 。 热 板 6 在 腿 部 简 套 5 的 凸 
人 台 之 上 ， 通 过 螺栓 3 与 足 信 8 相连 接 ; 圆锥 文 撑 杆 11 通过 足 端 蝶 杆 17、 连 接 螺杆 18 分 别 
与 焉 和 直 力 转换 产 置 12 和 下 弹 圭 导 杆 4 相连 接 ; 连 接 螺 杆 固定 闭 置 19 用 于 固定 连接 螺杆 ; 一 
级 减 震 弹 敌 10 被 固定 在 足 套 8 与 腿 部 套 简 $ 之 间 的 空间 内 ， 并 且 其 底 端 与 足 套 8 中 的 圆 
柱 同 台 相 接触 ,一 级 减 震 弹 竹 10 的 顶 问 与 腿 部 套 简 之 间 垫 有 垫圈 7, 达到 一 级 减 震 的 目的 ; 
上 强 结 导 杆 2 和 下 弹 苇 导 杆 4 可 以 在 腿 部 僚 简 中 上 下 滑动 ， 两 者 之 间 通 过 二 级 减 震 弹 引 9 
传递 力 的 作用 ， 以 达到 二 级 减 震 的 目 ， 从 而 将 最 终 传 到 传感器 上 的 力 限制 在 规定 的 0 一 SN 
范围 之 内 。 信 号 转换 及 放大 装置 1 是 固定 在 上 弹 筑 导 杆 2 和 腿 部 套 简 5 的 凸 台 之 间 ;ERF 电 
流 变 敏感 材料 13 上 部 与 机 器 人 腿 部 20 相连 接 ， 下 部 与 信号 转换 与 放大 模块 1 相 接触 。 足 
端 21 为 橡胶 材料 ， 套 在 腿 部 足 套 8 的 下 部 。 足 套 8 与 足 端 21 通过 螺纹 相连 。 重 直 力 转换 
装置 12 为 铝 质 材料 或 塑料 。 

当 多 足 式 机 器 人 的 足 端 21 与 地 面 接触 时 , 触 力 通 过 圆锥 文 撑 杆 11 传递 到 二 级 减 震 弹 短 9 
和 一 级 减 震 弹 知 10， 使 其 发 生 形 变 ， 从 而 使 达到 信号 转换 及 放大 装置 1 内 的 压力 在 力 敏 电阻 
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的 正常 感 测 范围 内 。 该 压力 使 R1、R2、R3、R4 组 成 的 弹性 膜 片 产生 形变 ， 形 成 正 、 负 两 个 
应 变 区 ， 同 时 压 敏 电阻 的 电阻 率 也 发 生 相 应 的 变化 ， 引 起 信号 转换 电 桥 14 不 平衡 ， 产 生 一 个 
与 压力 成 正比 的 电信 和 号。 电信 和 号 通过 信和 号 转换 及 放大 闭 置 1 内 的 信号 放大 模块 15 和 输出， 一 路 
输入 AD 转换 器 而 男 一 路 输入 ERF 电流 变 敏感 材料 减 震 装置 13。 输 入 ERF 电流 变 敏感 材料 
的 电信 号 使 敏感 材料 的 状态 发 生变 化 ， 从 而 收 到 实时 、 目 适应 减 震 的 效 末 。 供 电 模 块 16 则 用 
于 问 信 号 转换 及 放大 装置 1 供电 。 

当 多 足 式 机 器 人 的 足 冯 与 地 面 分 离 时 ， 二 级 减 震 弹 得 9 和 一 级 减 展 弹 引 10 恢复 为 初始 状 
态 ， 弹 性 膜 片 也 恢复 为 初始 状态 。 此 时 电 桥 14 平衡 ， 无 电信 号 输出 ， 因 此 减 震 闭 置 中 的 ERF 
电流 变 敏 感 材 料 13 也 恢复 到 初始 状态 。 
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一 种 适用 于 特种 机 器 人 的 超声 波 测 距 系统 专利 


专利 名 称 : 一 种 适用 于 特种 机 右 人 的 超声 肖 测 距 系统 
发 明 人 : 多 庆生 ; 畦 军 玲 ; 赵 小 咱 


一 种 适用 于 特种 机 器 人 的 超声 小 测 距 系统 








技术 领域 
本 发 明 涉及 一 种 适用 于 特种 机 如 人 的 超声 波 测 距 系 统 ， 属 于 机 如 人 传 感 占 领域 。 
背景 技术 








超声 波 传 感 器 具有 信息 处 理 简 单 、 成 本 低廉 等 优点 ， 被 广泛 用 做 机 问 人 测 距 传感器 ， 以 
实现 环境 探测 和 导航 任务 。 

超声 波 测 距 利 用 的 是 超声 波 近似 直线 传播 和 反射 的 特性 ， 目 前 常用 的 测 距 方式 是 单 脉冲 
方式 。 超 声波 换 能 器 在 单 脉 训 的 触发 下 将 超声 波 发 射出 去 ， 超 声波 在 介质 中 传播 到 被 测 物体 
后 被 反射 。 超 声波 换 能 器 接收 到 反射 回 波 信和 号， 确定 出 超声 波 从 发 射 到 接收 的 渡 越 时 间 ， 超 
声波 传播 的 速度 用 340m/s 近似 代替 。 

特种 机 器 人 第 第 工作 在 非 结 构 环 境 下 ， 在 实际 测 距 过 程 中 ， 环 境 中 温度 、 湿 度 、 和 气压 
对 超声 波 的 传播 速度 都 会 产生 影响 , 其 中 温度 变化 的 影响 最 大 ,因此 用 340m/s 近似 代 蔡 超 
声波 传播 的 速度 会 引入 误 关 ;其 次 超声 波 回 流 信 号 是 一 个 调制 信号 ， 无 明确 的 回 淫 信 号 前 
沿 ， 因 而 在 确定 渡 越 时 间 的 过 程 中 ， 其 基准 点 的 选择 已 构成 测量 误差 的 主要 来 源 ， 在 非 结 
构 环境 下 ， 了 噪声 与 回 波 同时 被 接收 ， 即 使 电路 中 带 有 滤波 电路 ， 与 脉 神 频率 相近 的 噪声 依 
旧 无 法 滤 除 ， 这 将 造成 误 触 发 ， 上 述 问 题 已 成 为 制约 超声 流传 感 需 在 特种 机 器 人 领域 应 用 
的 瓶颈 。 

发 明 内 容 

本 发 明 的 目的 在 于 提供 一 种 适用 于 特种 机 器 人 的 超声 波 测 距 系统 ， 来 解决 在 实际 测 距 过 
程 中 ， 环 境 、 超 声波 回 波 信和 号 基准 点 的 选择 、 噪 声 干 扰 等 因素 对 传播 速度 测量 影响 大 的 问题 。 

本 发 明 提供 的 一 种 适用 于 特种 机 器 人 的 超声 波 测 距 系 统 ， 访 系统 包括 渡 越 时 间 确 定 模 块 、 
超声 波 传 播 速度 实时 测量 模块 。 

1) 洲 越 时 间 确 定 模块 主要 包括 超声 波 发 射 换 能 模块 、 超 声 汲 接收 换 能 模块 、 超 声波 发 射电 
路 模块 、 回 波 接 收 、 放 大 、 滤 波 电 路 模块 和 姐 入 式 数 字 信 号 处 理 模块 (DSP TMS320VC5509A); 
人 先 入 式 数 字 信 号 处 理 横 块 内 部 的 运算 程序 包括 m 序列 发 生 模 块 、 本 地 码 发 生 模 块 、m 序列 还 原 
模块 和 相关 判决 模块 等 ; 超声 波 发 射 换 能 模块 通过 超声 波 发 射电 路 模块 与 仍 入 式 数 字 信 和 号 处 理 
模块 相连 ， 超 声波 接收 换 能 模块 通过 回 波 接收 、 放 大 、 波 波 电路 模块 与 藤 入 式 数 字 信 和 号 处 理 
模块 相连 ， 超 声波 发 射 换 能 模块 与 超声 波 接收 换 能 模块 发 射 、 接 收 方 回 平 行 且 紧密 相 邻 。 

渡 越 时 间 确 定 模块 的 工作 过 程 为 : 基于 伪 随 机 序列 的 目 相 关 性 原理 ， 由 般 入 陈 数 学 信和 号 
处 理 模 块 通过 m 序列 发 生 模 块 产生 的 伪 随 机 序列 经 通用 IO 引 脚 输出 ， 激 励 超声 流 发 射电 路 
模块 将 其 转换 成 对 应 的 超声 波 信 号 ， 通 过 超声 波 发 射 换 能 模块 发 射出 去 ， 超 声波 经 隐 碍 物 反 
射 到 超声 波 接收 换 能 模块 ， 通 过 回 波 接收 、 放 大 、 滤 波 电路 模块 将 其 滤波 、 放 大 后 ， 经 过 AD 
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转换 ， 输 入 给 网 入 式 数 学 信号 处 理 模块 的 m 序列 还 原 模 块 ，m 序列 还 原 模块 将 其 还 原 成 对 应 
的 离散 序列 ， 与 本 地 码 发 后 模块 产生 的 伪 随 机 序列 通过 相关 判决 模块 的 相关 运算 公式 进行 运 
算 。 当 相关 冰 数 值 取 值 最 大 时 ， 通 过 本 地 伪 随 机 序列 与 接收 到 的 伪 随 机 序列 的 相位 差 便 可 确 
定 障 人 碍 物 与 超声 波 换 能 模块 之 间 的 渡 越 时 间 。 

2) 超声 波 传播 速度 实时 测量 模块 : 主要 包括 长 方 体 目标 、 超 声 流 发 射 换 能 模块 、 超 声 泌 
接收 换 能 模块 、 超 声波 发 射电 路 模块 、 回 这 接收 、 放 大 、 滤 波 电 路 模块 和 先入 式 数 字 信 号 处 
理 模 块 ， 髓 入 式 数 学 信号 处 理 模 块 内 部 的 运算 程序 包括 m 序列 发 生 模块 、 本 地 人 码 发 生 模 块 、 
m 序列 还 原 模 块 和 相关 判决 模块 等 ， 超 声波 发 射 换 能 模块 通过 超声 波 发 射电 路 模块 与 通 入 式 
数字 信号 处 理 模块 相连 ， 超 声波 接收 换 能 模块 通过 回 波 接收 、 放 大 、 滤 波 电路 模块 与 嵌入 陈 
数字 信号 处 理 模块 相连 ， 超 声波 发 射 换 能 模块 与 超声 波 接 收 换 能 模块 发 射 、 接 收 方 同 平行 且 
紧密 相 邻 ， 长 方 体 目 标 固定 于 超声 波 发 射 换 能 模块 与 超声 波 接收 换 能 模块 前 哨 ， 距 离 为 4 

(30cm<a<lm ) 

超声 波 传播 速度 实时 测量 模块 的 工作 过 程 为 : 基于 伪 随 机 序列 的 自 相 关 性 原理 ， 由 和 藤 入 
式 数字 信和 号 处 理 模 块 通过 m 序列 发 生 模块 产生 的 伪 随 机 序列 经 通用 WO 引 脚 输出 ， 激 励 超声 
流 发 射电 路 模块 将 其 转换 成 对 应 的 超声 波 信 号 ， 通 过 超声 波 发 射 换 能 模块 发 射出 去 ， 超 声 沁 
经 长 方 体 目标 反射 到 超声 波 接 收 换 能 模块 ， 通 过 回 波 接收 、 放 大 、 滤 波 电路 模块 将 其 滤波 、 
放大 后 ， 经 过 A/D 转换， 输入 给 嵌入 式 数字 信号 处 理 模块 的 mm 序列 还 原 模块 ，m 序列 还 原 模 
块 将 其 还 原 成 对 应 的 离散 序列 ， 与 本 地 码 发 生 模 块 产 生 的 伪 随 机 序列 通过 相关 判决 模块 的 相 
关 运 算 公 式 进 行 运算 。 当 相关 函数 值 取 值 最 大 时 ， 通 过 本 地 伪 随 机 序列 与 接收 到 的 伪 随 机 序 
列 的 相位 甜 ， 便 可 确定 长 方 体 目标 与 超声 波 换 能 模块 之 间 的 湾 越 时 间 ， 计 算 长 方 体 目 标 距 超 
声波 换 能 模块 的 距离 值 4 与 渡 越 时 间 比 值 的 二 倍 便 为 超声 波 传 播 速度 。 

通过 滤 越 时 间 确 定 模 块 来 测量 障碍 物 与 超声 波 换 能 模块 之 间 的 渡 越 时 间 ， 通 过 超声 波 传 
播 速 度 实时 测量 模块 来 测量 机 器 人 所 处 环境 的 实际 声波 速度 ， 应 用 散 入 式 数 学 信和 与 处 理 模 块 
通过 计算 渡 越 时 间 和 超声 波 传播 速度 乘积 值 的 一 半 ， 得 出 机 器 人 距离 障碍 物 的 距离 。 本 发 明 
的 一 种 适用 于 特种 机 器 人 的 超声 波 测 距 系统 的 测 距 有 效 值 范 围 是 0.3 一 8.9m。 

本 发 明 的 有 益 效 果 有 : 

1) 增加 了 超声 流传 播 速 度 实 时 测量 模块 ， 访 模块 基于 伪 随 机 序列 的 目 相关 性 准确 地 测量 滤 
越 时 间 后 ， 再 利用 模块 中 目标 物体 与 超声 波 换 能 模块 距离 已 知 的 条 件 ， 计 算出 超声 波 的 传播 速 
度 。 克服 了 传统 超声 小 测 距 传感器 因为 超声 波 传播 速度 随 温 度 、 压 强 的 变化 而 造成 误差 的 缺点 。 

2) 采用 基于 伪 随 机 序列 目 相 关 性 原理 测量 渡 越 时 间 , 有 效 地 提高 了 流 越 时 间 测 量 的 精度 ， 
消除 了 噪声 的 干扰 。 

3) 采用 瞬 入 式 数 字 信 和 号 处 理 模 块 处 理 信 号 ， 有 效 地 提高 了 信息 处 理 的 实时 性 。 

4) 采用 模块 化 设计 ， 结 构 简 单 ， 功 能 可 徘 ， 可 广泛 应 用 于 各 种 特种 机 器 人 。 访 系统 对 于 
提高 特种 机 器 人 的 探测 能 力 ， 增 加 机 器 人 对 未 知 环境 的 适应 能 力 具 有 重要 的 作用 ， 可 进一步 
扩大 特种 机 器 人 在 民用 、 军 事 等 领域 的 应 用 。 

附 图 说 明 

附 图 G-1 为 疲 越 时 间 测 定 的 工作 原理 图 。 

附 图 G-2 为 超声 小传 播 速度 实时 测量 的 工作 原理 图 。 

附 图 G-3 为 超声 波 测 距 闭 置 的 外 观 结构 图 。 
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附 图 G-4 为 超声 波 测 距 闭 置 在 特种 机 器 人 上 应 用 的 示意 图 。 

以 上 附 图 中 ，1 一 障碍 物 ; 2 一 超声 波 发 射 换 能 模块 ，3 一 超声 波 接 收 换 能 模块 ，4 一 超声 
流 发 射电 路 模块 ; $ 一 接收 、 放 大 、 滤 波 电路 模块 ;6 一 m 序列 发 生 模 块 ，7 一 本 地 码 太 生 模 块 ， 
83 一 m 序列 还 原 模块 ;9 一 相关 判决 模块 ;10 一 租 入 式 数 字 信 号 处 理 模块 DSP TMS320VC5509A:; 
11 一 长 方 体 目 标 。 

具体 实施 方式 

下 面 结合 附 图 G-1 一 附 图 G-4 实施 例 对 本 发 明 作 进一步 说 明 。 

以 测试 环境 温度 为 23.3C， 压 强 为 100.76kPa， 相 对 湿度 为 15% 为 例 ， 取 不 同 的 实际 距离 
进行 测量 ， 检 验 本 发 明 的 误差 。 

测量 具体 步骤 如 下 : 

1) 通 过渡 越 时 间 确 定 模 块 来 测量 障碍 物 与 超声 波 换 能 模块 之 间 的 渡 越 时 间 。 如 附 图 
G-1 所 示 ， 超 声波 发 射 换 能 模块 2 通过 超声 波 发 射电 路 模块 4 与 艇 入 式 数 字 信 号 处 理 模块 
10 相连 ， 超 声波 接收 换 能 模块 3 通过 回 波 接 收 、 放 大 、 小 波 电 路 模块 5 与 舱 入 式 数 学 信和 与 
处 理 模 块 10 相连 ， 超 声波 发 射 换 能 模块 2 与 超声 波 接 收 换 能 模块 3 发 射 、 接 收 方向 平行 
且 紧 密 相 邻 。 由 嵌入 式 数字 信和 号 处 理 模块 10 通过 m 序列 发 生 模 块 6 产生 的 m 序列 通过 通 
用 LO 引 脚 输出 ， 激 励 超声 波 发 射电 路 模块 4 将 其 转换 成 对 应 的 超声 波 信号 ， 通 过 超声 波 
发 射 换 能 模块 2 发 射出 去 ， 超 声波 经 障碍 物 1 反射 到 超声 波 接收 换 能 模块 3， 通 过 接收 、 
放大 、 滤 波 电 路 模块 5 将 其 滤波 、 放 大 后 ， 经 过 A/D 转换， 输入 给 m 序列 还 原 模块 8，m 
序列 还 原 模块 8 将 其 还 原 成 对 应 的 离散 序列 ， 与 本 地 码 发 生 模块 7 产生 的 伪 随 机 序列 通过 
相关 判决 模块 9 的 相关 运算 公式 进行 运算 。 当 相关 函数 值 取 值 最 大 时 ， 通 过 本 地 伪 随 机 序 
列 与 接收 到 的 伪 随 机 序列 的 相位 差 便 可 确定 隐 碍 物 1 与 超声 波 发 散 换 能 模块 2、 超 声波 接 
收 换 能 模块 3 之 间 的 渡 越 时 间 。 

2) 通过 超声 波 传 播 速 度 实 时 测量 模块 来 测量 机 器 人 所 处 环境 的 实际 声波 速度 。 如 附 
图 G-2 所 示 ， 超 声波 发 射 换 能 模块 2 通过 超声 波 发 射电 路 模块 4 与 租 入 式 数 字 信 号 处 理 
模块 10 相连 ， 超 声波 接收 换 能 模块 3 通过 回 波 接收 、 放 大 、 滤 波 电 路 模块 5 与 乱入 式 数 
字 信 号 处 理 模块 10 相连 ， 超 声波 发 射 换 能 模块 2 与 超声 波 接收 换 能 模块 3 发 射 、 接 收 方 
问 平 行 且 紧密 相 邻 ， 长 方 体 目 标 固定 于 超声 波 发 射 换 能 模块 与 超声 波 接 收 换 能 模块 前 端 ， 
距离 为 42.3cm。 由 嵌入 式 数字 信和 号 处 理 模块 10 通过 m 序列 发 生 模块 6 产生 的 m 序列 通 
过 通用 V0 引 脚 输出 ， 激 励 超声 波 发 射电 路 模块 4 将 其 转换 成 对 应 的 超声 波 信号 ， 通 过 超 
声波 发 射 换 能 模块 2 发 射出 去 ， 超 声波 经 长 方 体 目 标 11 反射 到 超声 波 接收 换 能 模块 3， 
接收 、 放 大 、 滤 波 电 路 模块 $ 将 其 滤波 、 放 大 后 ， 经 过 Am 转换 ， 输 入 给 m 序列 还 原 模 
块 8，m 序列 还 原 模块 8 将 其 还 原 成 对 应 的 离散 序列 ,与 本 地 人 码 发 生 模块 7 产生 的 伪 随 机 
序列 通过 相关 判决 模块 9 的 相关 运算 公式 进行 运算 。 当 相关 函数 值 取 值 最 大 时 , 通过 本 地 
伪 随 机 序列 与 接收 到 的 伪 随 机 序列 的 相位 差 便 可 确定 长 方 体 目标 与 超声 波 换 能 模块 之 间 
的 渡 越 时 间 。 计 算 长 方 体 目标 距 超 声波 换 能 模块 的 距离 与 渡 越 时 间 比 值 的 三 倍 便 为 超声 波 
传播 速度 。 

3) 取 渡 越 时 间 与 机 器 人 所 处 环境 中 的 超声 波 传播 速度 的 乘积 的 一 半 ， 得 出 机 器 人 距离 障 
碍 物 的 距离 ， 这 一 过 程 在 嵌入 式 数字 信和 号 处 理 模块 中 完成 ， 直 接 输 出 实验 结果 见 附 表 G-1。 
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附 表 G-1 实验 结果 


从 上 述 实验 结果 中 可 以 看 出 ， 本 发 明 的 适用 于 特种 机 器 人 的 新 型 超声 波 测 距 装 置 的 测量 
误差 乏 0.1%， 具 有 较 高 的 精度 和 良好 的 抗 干 扰 能 
说 明 书 附 图 
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附 图 G-1 小 越 时 间 测 定 的 工作 诛 理 图 
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附 图 G-2 超声波 传播 速度 实时 测量 的 工作 原理 图 
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附 图 G-3 超声波 测 距 闭 转 的 外 观 结构 图 附 图 G-4 超声 波 测 距 萎 症 在 特种 机 器 人 上 应 用 的 示意 良 
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技术 领域 
本 发 明 属 于 仿生 机 磊 人 应 用 领域 ， 具 体 涉及 一 种 基于 模 基 化 的 多 关节 链 节 式 机 堪 人 。 
背景 技术 








随 看 生物 学 对 于 人 类 和 其 他 动物 的 神经 系统 及 生活 方式 研究 的 逐步 深入 ， 念 生 学 技术 的 
研究 依靠 看 科学 技术 的 发 展 也 飞速 前 进 ， 创 造 了 科学 撤 术 和 生物 学 研究 乙 间 学 科 交 叉 的 广阔 
研究 领域 。 在 对 生物 神经 系统 的 结构 和 功能 进行 分 析 和 借鉴 的 基础 上 ， 国 内 外 各 研究 单位 先 
后 研发 了 一 系列 的 仿生 学 机 器 人 ， 模 仿生 物 、 从 事 适 合生 物 特点 的 工作 ， 并 力求 能 达到 尽 可 
能 高 的 生物 相似 度 水 平 ， 以 实现 流畅 目 然 的 动作 和 神经 反射 ， 到 达 更 加 完 关 可 对 的 运动 控制 
效 朱 。 

鉴于 目前 的 仿生 机 需 人 研究 在 仿生 效 末 、 能 源 消 耗 、 实 际 用 途 、 科 技 应 用 等 各 方面 仍 存 
在 很 大 的 研究 空间 ， 因 此 在 仿生 研究 的 基础 上 ， 保 留 机 器 本 喘 的 轮 式 运动 的 同时 结合 生物 腿 
式 运 动 的 特点 ， 设 计 一 玖 拥有 轮 式 快速 运动 和 腿 陈 适应 性 强 的 特点 的 节 胶 机 郝 人 是 一 个 有 很 
高 研究 价值 和 应 用 前 景 的 工作 。 其 中 日 本 千 叶 理工 学 院 设计 的 Halluc II 型 八 足 机 器 人 兼 具 上 
述 运动 特色 。 但 由 于 此 机 需 人 只 有 腿 部 的 创新 ， 各 个 运动 足 乙 间 使 用 一 块 平 极 连 接 的 设计 不 
能 展现 摆动 、 起 伏 类 动作 ， 限 制 了 此 类 轮 足 式 机 喜人 的 姿态 展示 。 

增加 腰椎 结构 的 设计 ， 对 每 组 运动 足 实 现 模块 化 连接 ， 使 每 组 运动 足 实现 不 同 角度 与 方 
问 的 姿态 变化 正 是 多 关节 模块 化 的 链 节 式 机 天 人 所 研究 完成 的 工作 。 

发 明 内 容 

本 发 明 为 一 种 可 以 实现 模块 化 组 合 的 多 关节 链 市 式 机 各 人 。 该 机 占 人 采用 模块 化 的 开 链 
结构 ， 每 个 模 基 有 十 二 个 目 由 度 ， 每 个 目 由 上 度 都 由 此 机 或 直流 电动 机 张 动 完 成 。 机 器 人 的 每 
个 运动 足 由 四 个 曲 臂 关节 和 一 个 轮 足 组 成 ， 共 有 五 个 主动 目 由 度 ， 两 个 对 称 布置 的 运动 足 组 
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成 一 对 关 市 ， 两 对 关 市 之 间 通 过 链 节 式 腰 部 关节 连接 ， 腰 部 天 证 有 两 个 主动 日 由 度 ， 可 实现 
在 四 个 相互 垂直 方 况 上 的 灵活 转动 。 通 过 模块 化 组 合 ， 该 机 喜人 可 实现 轮 式 和 腿 式 、 直 行 与 
摆动 的 运动 特性 的 有 机 融合 ， 使 其 既 有 腿 式 机 器 人 地 形 适 应 能 力 踢 、 路 越 队 但 特性 好 和 机 映 
姿态 元 活 多 变 的 优点 ， 义 有 轮 陈 机 器 人 机 动 速度 快 、 平 衡 能 力 好 的 优点 。 同 时 腰部 宽度 的 设 
计 ， 使 得 机 喜人 在 前 进 或 后 退 时 的 步 长 和 运动 能 满足 不 干涉 条 件 。 多 对 运动 足 乙 间 的 协调 配 
合 可 使 机 闫 人 能 完成 儿 十 种 运动 步 态 ， 并 能 跨越 一 定 高 度 的 隐 但 物 。 

其 中 ， 模 块 化 的 设计 思想 ， 可 以 实现 两 组 模块 以 上 的 任意 组 模块 拼接 ， 通 过 模块 姑 活 地 进 
行 增 减 实现 不 同 的 步 态 展现 和 运动 套路 ;模块 间距 设计 ， 即 腰部 宽度 的 设计 ， 使 得 机 器 人 在 前 
进 或 后 退 时 的 步 长 和 运动 能 满足 设计 要 求 ， 不 全 于 运动 时 前 后 腿 相 冲突 ， 运动 足 各 天 下 之 间 的 
距离 设计 ， 可 使 得 机 费 人 的 各 关 市 能 在 预定 的 角 拔 范围 内 转动 ， 运 动 丰 足 瓜 滚轮 的 斜率 设计 ， 
可 使 得 机 问 人 在 横 问 侧 行 步 态 时 腿 部 圭 曲 的 角度 恰好 使 滚轮 看 地 点 与 地 面相 切 。 这 种 凄 置 具有 
结构 紧凑 、 承 载 能 力 强 、 足 问 可 达 域 三、 抗 干扰 能 力 强 、 欣 制 方便 、 运 动 灵 活 等 特点 。 

为 了 实现 上 述 发 明 目 的 ， 多 关 市 模块 化 组 合 的 链 节 式 机 寓 人 设计 由 多 组 以 下 部 件 组 成 : 腿 
前 部 曲 句 、 腿 后 部 曲 辟 、 直 流 电动 机 外 元 、 电 动机 延伸 套 、 轮 子 外 僚 、 轮 蕊 、 腿 轴 、 脚 部 插 板 、 
骨 机 支撑 染 一 、 骨 机 支撑 染 二 、 骨 机 支撑 染 三 、 骨 机 支撑 染 四 、 艇 机 支撑 架 五 、 骨 机 支撑 染 六 、 
纶 机 壕 撑 染 七 、 绥 冲 执 、 采 部 模板 、 次 轮 箱 、 轴 承 盖 、 上 下 转动 件 、 腰 椎 、 轴 承 兽 蓄 、 执 片 、 
左右 转动 件 、 左 右 连 接 件 、 沉 尖 螺 条 、 左 右 艇 机 固定 架 、 衣 机 、 垫 厂 、 圆 柱 齿 轮 、 骨 盘 蝶 和 钉 、 
艇 机 螺钉、 屹 盘 、 腰 轴 、 螺 杀 、708C 轴承 、 上 下 连接 件 、 上 下 骨 机 国定 架 。 其 中 ， 舱 机 安装 在 
屁 机 文 撑 架 内 ， 直 流 电 动机 安 儿 在 二 流 电动 机 外 元 崩 ， 电 动机 文 架 通过 螺钉 固定 在 机 体 上 ， 锥 
齿轮 与 电动 机 轴 相 连 。 主 要 设计 包括 以 下 结构 : GO 模块 间距 设计 : 通过 测量 可 得 最 底 端的 舵 机 
轴 距 离 足 压 问 橡胶 确 的 距离 和 运动 分 析 可 知 ， 运 动 丰 要 能 够 绕 最 底 病 的 衣 机 轴 平 角 旋转 ， 因 此 
设计 艇 机 轴 到 胶 底 距离 及 两 足 之 间距 离 ， 以 保证 使 两 足 能 够 同时 旋转 而 不 发 生 和 干涉。 腰部 续 
构 设 计 : 通过 对 力矩 强度 校 核 ， 设 计 出 具有 两 个 腰椎 一 侧 固 连 ， 运 动 方向 互 为 垂直 的 两 月 由 度 
腰部 结构 。@ 运 动 足 昌 臂 的 设计 : 通过 对 运动 足 动作 的 设计 要 求 的 分 析 可 知 ， 曲 臂 由 两 部 分 组 
成 ， 通 过 调整 矿 寸 ， 使 扎 角 为 百 角 。 多 胱 机 包围 络 构 : 根据 舵 机 的 矿 寸 大 小 ， 来 确定 包围 结构 
外 壳 的 太 寸 。 并 通过 精细 的 测量 来 确定 背 板 上 和 能 机 对 称 位 置 安装 轴 的 位 置 ， 从 而 保证 了 对 称 
性 。 此 外 ， 在 设计 时 ， 两 侧 预 留 出 了 误 革 允许 范围 的 安 沪 间 际 ， 以 方便 调整 。 

本 发 明 的 优点 在 于 : 

1) 模块 化 设计 的 思想 ， 实 现 了 机 右 人 组 站 拼 接 的 任意 性 ， 实 现 了 最 大 程度 的 步 态 规划 与 
拓展 。 

2) 结合 腿 式 与 轮 式 仿生 机 帮 人 的 特点 ， 运 动 足 曲 恬 和 轮 式 设计 使 其 妹 有 腿 式 机 帮 人 适应 
地 形 能 力 强 、 机 身 有 灵活 的 优点 ， 又 有 轮 陈 机 器 人 机 动 速度 快 、 机 体 平 衡 控 制 能 力 强 的 优点 。 

3) 利用 锥 南 轮 避免 了 电动 机 直接 承受 径 加 负载, 近 融 了 电动 机 的 使 用 寿命 , 增 大 了 力矩 。 

附 图 说 明 

附 图 H-1 为 基于 多 关 市 模块 化 的 链 市 式 机 各 人 整体 示意图 。 

附 图 H-2 为 基于 多 关 市 模块 化 的 链 市 式 机 器 人 主 视图 。 

附 图 H-3 为 基于 多 关 市 模块 化 的 链 市 式 机 右 人 左 视 图 。 

附 图 H-4 为 基于 多 关 市 模块 化 的 链 市 式 机 右 人 作 视 图 。 

附 图 H-5 为 基于 多 关节 模块 化 的 链 贡 却 机 器 人 运动 足 双 足 组 合 设计 疼 。 


© 

























































































附录 


附 图 H-6 为 基于 多 关节 模块 化 的 链 节 式 机 堪 人 腰部 设计 装配 分 解 图 。 

附 图 H-7 为 基于 多 关节 模块 化 的 链 节 式 机 器 人 腰部 设计 主 视图 。 

附 图 H-8 为 基于 多 关节 模块 化 的 链 节 式 机 器 人 腰部 设计 俯视 图 。 

以 上 附 图 中 : 1 一 支架 ; 2 一 锥 齿轮 ， 3 一 轴承 ;， 4 一 1 号 舵 机 ，5$ 一 套 简 ;6 一 1 号 轴 ; 7 一 
吴 板 ;，8 一 键 ; 9 一 蝶 钉 ，10 一 和 腿 前 部 曲 锅 ，11 一 轴承 ; 12 一 表 机 支撑 架 一 ，13 一 2 与 能 机 ，14 一 
轴承 ; 15 一 舵 机 支撑 架 一 ，16 一 舵 机 支撑 架 三 ，17 一 3 号 舵 机 ;18 一 艇 机 支撑 架 五 ，19 一 和 衣 机 
支撑 架 六 ; 20 一 4 号 能 机 ;，21 一 轮子 外 套 ，22 一 轮 世 :23 一 卡 短 ，24 一 绥 冲 热 ，25 一 插 板 ，26 一 
下 法 电动 机 ;27 一 电动 机 支架 ; 28 一 和 能 机 文 撑 架 六 ;29 一 艇 机 文 撑 架 二 ;30 一 能 机 文 撑 架 七 ; 
31 一 腿 后 部 曲 侣 ，32 一 横 板 ; 33 一 和 能 机 文 撑 架 二 ; 34 一 虹 母 ，35 一 盘 机 文 撑 架 四 ; 36 一 上 下 
转动 件 ，37 一 腰椎 2，38 一 轴承 问 盖 ，39 一 热 片 ，40 一 左右 转动 件 ，41 一 左右 连接 件 ，42 一 沉 
头 螺钉 M3; 43 一 左右 能 机 固定 架 ; 44 一 和 能 机 ;45 一 热 片 ，46 一 圆柱 齿轮 ，47 一 能 盘 螺 多 M2; 
48 一 舵 机 螺钉 M3;，49 一 通盘，50 一 腰 轴 ;， 51 一 螺钉 M3; 52 一 708C 轴承 ，5$3 一 腰椎 1，54 一 
上 下 连接 件 ，$$ 一 上 下 上 舵 机 固定 架 。 

具体 实施 方式 

如 附 图 H-1 所 示 ， 为 基于 多 关节 模块 化 的 链 节 式 机 器 人 整体 示意 图 ， 由 四 组 腰 腿 部 模块 
连接 而 成 ， 是 一 种 八 足 机 器 人 。 共 有 46 个 目 由 度 , 每 对 足 之 间 由 三 组 腰部 连接 模 块 连接 而 成 。 

如 附 图 H-3 所 示 ，1 号 艇 机 通过 一 号 轴 与 下 部 相连 ， 避 人 免 了 电动 机 轴 直 接 承 受 径 问 载 人 入， 
提高 了 电动 机 的 使 用 寿命 。 

如 附 图 H-5 所 示 ， 安 钱 运 动 足 时 ， 骨 机 文 撑 架 一 、 能 机 文 撑 架 二 、 凡 机 文 撑 架 三 螺钉 固 连 ， 
放 入 2 号 能 机 13 后 用 ~ 舵 机 支撑 架 四 通过 螺钉 固 连 。 再 放 入 3 号 舵 机 17 后 ， 通 过 另 一 组 能 机 支撑 
染 一 、 骨 机 支撑 架 二 、 艇 机 支撑 架 五 、 骨 机 支撑 架 三 固定 3 写 艇 机 17， 通 过 螺钉 回 连 。 再 将 腿 前 
部 曲 辟 和 腿 后 部 曲 句 31 分 别 固 连 2 号 、3 号 紫 机 17 的 两 侧 舵 机 支架 ， 中 间 用 模板 固定 。 艇 机 支 
撑 架 五 、 议 机 文 撑 架 六 、 能 机 文 撑 七 通过 螺钉 固定 4 号 骨 机 。 后 用 直流 电动 机 外 膏 国 定 直 流 电 动 
机 ， 插 入 插 板 固定 ， 后 套 入 卡 短 和 硬 橡胶 材质 缓冲 热 ， 后 部 套 电动 机 延伸 套 ， 前 部 套 入 轮 尼 ， 装 
轮子 外 套 。 这 样 实现 了 三 个 和 能 机 为 主动 自由 度 和 一 个 直流 电动 机 为 主动 目 由 度 的 组 装 。 与 此 过 程 
类 似 ， 完 成 男 一 四 上 自由 上 度 腿 部 组 装 后 ， 通 过 一 个 连接 平板 可 连接 两 部 分 机 构 ， 在 骨 机 文 撑 染 四 上 
部 通过 轴承 与 连接 板 相连 ， 连 接 板 上 部 通过 文 妨 用 螺钉 固定 1 写 舱 机 ， 后 用 锥 齿轮 咕 合 1 号 轴 ，1 
写 轴 通 过 轴承 连接 2 号 能 机 。 这 样 束 可 以 实现 单 运 动 足 五 个 主动 目 由 上 度 ， 双 足 连 接 十 个 主动 目 由 
度 的 运动 足 组 装 。 利 用 1 号 轴 通 过 连接 板 上 的 孔 插 入 轴承 内 圈 ， 避 免 了 电动 机 轴 直 接 有 承受 径 疝 载 
何 ， 提 高 了 电动 机 的 使 用 寿命 ， 同 时 连接 板 下 3 个 衣 机 的 布置 为 腿 部 的 侧 癌 摆动 提供 了 更 强 的 动 
2 

如 附 图 H-6 所 示 ， 安 装 腰 部 结构 时 ， 将 腰椎 1 (53) 与 腰椎 2 (37) 用 四 个 螺钉 固 连 ， 腰 
椎 2 (37) 与 左右 转动 件 40 通过 腰 轴 3$0 相连 ， 可 使 腰部 带动 模块 实现 水 平方 同 绕 轴 运 动 。 将 
腰椎 2 (37) 与 上 下 转动 件 36 通过 轴承 相连 ， 可 使 腰部 带动 模块 实现 垂直 方向 绕 轴 运动 。 将 
上 下 转动 件 36 与 上 下 连接 件 54 通过 四 个 螺钉 固 连 ， 放 入 能 机 后 利用 能 机 文 撑 架 连接 到 文 撑 
平板 上 。 将 左右 转动 件 40 与 左右 连接 件 41 回 连 后 放 入 艇 机 44， 用 上 下 能 机 固定 架 55 固定 。 
在 腰 轴 50 外 固 连 圆柱 齿轮 46， 以 实现 路 合 平板 齿轮 。 将 腰椎 连接 部 件 与 运动 足 的 腿 前 部 曲 臂 
和 轮 腿 式 结 构 通 过 模块 化 组 合 ， 实 现 不 同 模块 数量 的 闭 配 与 步 态 规划 。 
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附 图 H-1 基于 多 关节 模块 化 的 链 节 式 机 器 人 整体 示意 图 
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附 图 H-3 基于 多 关节 模 甘 化 的 链 节 式 机 器 人 左 视图 


© 


附录 







> 


上 


a 
区 






附 图 H-5 基于 多 关 闻 模块 化 的 链 节 式 机 器 人 运动 足 双 足 组 合 设计 网 














附 图 H-6 基于 多 关 市 模块 化 的 链 节 式 机 费 人 腰部 设计 六 配 分 解 图 
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附 图 H-8 基于 多 关 市 模块 化 的 链 凶 式 机 避 人 上 腰部 设计 从 视图 





欧 琶 理 一 种 节肢 机 器 人 的 轮 腿 式 运 动 足 设计 专利 


专利 名 称 ， 一 种 节肢 机 器 人 的 轮 腿 式 运动 足 设计 
发 明 人 : 罗 庆 生 ; 辆 宝 零 ; 魏 天 怠 ;， 喘 洋 ; 吴 帆 ;起 佳 避 ;， 毛 明 哲 ， 吴迪 


一 种 节肢 机 器 人 的 轮 腿 式 运 动 足 设计 





技术 领域 

本 友 明 属于 仿生 机 需 人 应 用 领域 ， 具 体 涉及 一 种 多 步 态 节肢 机 器 人 的 轮 腿 式 运动 足 设 计 。 

背景 技术 

由 于 仿生 移动 机 右 人 涉及 了 机 械 、 目 动 化 、 信 息 、 材 料 、 人 工 智 能 等 多 个 学 科 ， 叉 有 看 
广阔 的 应 用 前 景 ， 因 此 仿生 移动 机 需 人 的 研究 一 二 是 机 闫 人 领域 研究 的 热点 之 一 。 


运动 足 机 构 是 多 足 机 妖 人 行走 的 执行 机 构 ， 它 是 多 足 机 器 人 实现 多 种 步 态 不 干涉 行走 的 
关键 环 节 。 运 动 足 机 构 设 计 的 好 坏 和 直接 关系 到 多 足 机 右 人 是 否 可 以 完成 预 设 的 多 种 步 态 ， 因 
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此 关于 多 足 机 融 人 运动 足 的 设计 也 很 多 。 目 前 币 见 的 运动 足 机 构 有 四 杆 机 构 式 、 缩 放 式 、 伸 
综 式 及 天 而 式 等 。 就 目前 已 有 的 各 种 仿生 机 闫 人 运动 足 的 设计 而 言 ， 腿 陈 机 右 人 在 具有 地 形 
适应 性 强 的 优点 同时 ， 存 在 运动 速度 慢 ， 机 体 平 衡 控制 困难 的 不 足 ， 轮 却 机 右 人 机 动 速度 快 ， 
但 跨越 障碍 、 适 应 不 同 地 形 和 机 里 灵 活 运 动 的 能 力 和 有 人 欠缺 。 

保留 机 避 本 里 的 轮 式 运动 的 同时 结合 生物 腿 式 运动 的 特 皮 ， 设 计 一 球 拥 有 轮 式 快速 运动 
和 腿 却 适应 性 强 的 特点 的 节 胶 机 器 人 是 一 个 有 很 高 研究 价值 和 应 用 前 景 的 工作 。 其 中 日 本 千 
叶 理 工学 院 设 计 的 Halluc II 型 八 足 机 器 人 兼 具 上 述 运动 特色 。 他 们 的 运动 足 设 计 昌 然 共 有 续 
构 紧 凑 的 特点 ， 但 是 缺乏 承载 能 力 高 、 是 端 可 达 域 /、 抗 扰动 能 力 强 等 特点 。 

发 明 内 容 

本 发 明 的 内 容 在 于 提供 一 种 可 以 实现 多 种 预 设 步 态 厄 胶 机 器 人 的 轮 腿 式 运动 足 设计 。 该 设计 
采用 了 开 链 结构 ， 共 有 五 个 主动 目 由 度 ， 每 个 目 动 度 都 有 能 机 或 百 流 电动 机 驱动 完成 。 运 动 足 均 
采用 曲 臂 结构 设计 ， 拥 有 四 个 转动 关节 和 一 个 轮 足 ， 运 动 足 的 上 部 由 四 个 关节 组 成 ， 分 别 由 直流 
角 位 移 伺 服 电 动机 内 部 的 驱动 模块 驱动 ， 可 以 实现 机 右 人 的 腿 式 运动 ， 运 动 契 乓 部 为 一 直流 电动 
机 ， 用 来 驱动 负载 小 轮 ， 可 以 实现 机 各 人 的 轮 式 运动 。 运 动 足 的 看 地 剖 能 在 其 可 达 域 的 三 维 空间 
中 任 总 位 置 弦 地 。 依 徘 运动 足 的 独特 机 械 设计 和 关节 布局 , 使 其 虐 有 腿 式 机 器 人 适应 地 形 能 力 强 、 
跨越 障 但 能 力 强 和 机 号 灵活 的 优点 ， 又 有 轮 式 机 右 人 机 动 速度 快 、 机 体 平 衡 控制 能 力 强 的 优点 。 
多 对 运动 足 的 配合 使 用 可 以 使 机 器 人 能 完成 儿 十 种 运动 步 态 ， 并 能 路 越 一 定 高 度 的 隐 依 物 。 

其 中 ， 运 动 足 各 关 布 乙 间 的 距离 设计 ， 可 使 得 机 器 人 的 各 关节 能 在 预定 的 角度 范围 内 转 
动 ; 运动 足 足 撒 滚 轮 的 插 率 设计 ， 可 使 得 机 器 人 在 横 回 侧 行 步 态 时 腿 部 弯曲 的 角度 恰好 使 滚 
轮 看 地 点 与 地 面相 切 ， 各 运动 足 之 间 的 距离 间隔 设计 ， 使 得 机 右 人 在 前 进 或 后 退 时 的 步 长 和 
运动 能 满足 设计 要 求 ， 不 全 于 运动 时 前 后 腿 相 剖 突 。 这 种 猴 置 具有 结构 祭 凑 、 承 载 能 力 强 、 
足 冰 可 达 域 广 、 抗 干扰 能 力 强 、 控 制 方便 、 运 动 灵 活 等 特点 。 

为 了 实现 上 述 发 明 目 的 ， 节 胶 机 融 人 的 轮 腿 式 运 动 足 设计 由 腿 前 部 曲 彤 、 腿 后 部 曲 臂 、 直 流 
电动 机 外 训 、 电 动机 延伸 套 、 轮 子 外 余 、 轮 必 、 腿 轴 、 脚 部 插 板 、 艇 机 文 撑 架 一 、 骨 机 文 撑 架 二 、 
半 机 壕 撑 染 三 、 骨 机 支撑 架 四 、 骨 机 支撑 染 五 、 骨 机 支撑 架 六 、 骨 机 支撑 染 七 、 绥 冲 垫 、 上 腰部 村 
板 、 齿 轮 箱 、 轴 承 雷 组 成 。 骨 机 安 疙 在 艇 机 文 择 染 内 ， 直 流 电 动机 安装 在 且 尝 电动 机 外 完 内 ， 电 
动机 文 染 通 过 螺钉 固定 在 机 体 上 ， 锥 齿轮 与 电动 机 轴 相 连 。 主 要 设计 包括 以 下 结构 : (D 衣 机 包围 
结构 : 根据 能 机 的 太 寸 大 小 ， 来 确定 包围 结构 外 壳 的 太 寸 。 并 通过 精细 的 训 量 来 确定 育 板 上 和 能 
机 对 称 位 置 安装 轴 的 位 置 ， 从 而 保证 了 对 称 性 。 此 外 ， 在 设计 时 两 侧 预 留 出 了 误差 允许 范围 的 安 
装 间 隐 以 方便 调整 。 凶 运动 足 曲 臂 的 设计 : 通过 对 运动 足 动作 的 设计 要 求 的 分 析 可 知 ， 曲 臂 由 两 
部 分 组 成 ， 通 过 调整 信 寸 ， 使 扔 角 为 直角 。(3) 同 侧 两 运动 是 之 间距 离 设计 ， 通 过 测量 可 得 最 捅 闹 
的 艇 机 轴 距 离 足 压强 橡 股 的 的 距离 和 运动 分 析 可 知 ， 运 动 丰 要 能 够 绕 最 底 闹 的 艇 机 轴 平 角 旋 转 ， 
因此 设计 此 机 轴 到 胶 确 距离 及 两 足 之 间距 离 ， 以 保证 使 两 足 能 够 同时 旋转 而 不 发 生 干 涉 。 人 轮子 
圆 缴 计算 : 当 足 部 直流 电动 机 纪 定 氮 旋 转 时 ， 要 保证 轮子 的 曲面 与 过 定点 的 大 圆 相 切 ， 这 样 才 能 
保证 转动 的 平稳 ， 由 此 得 到 轮子 圆 弧 设计 。 

本 发 明 的 优点 在 于 : 

1) 结合 腿 式 与 轮 式 仿生 机 堪 人 的 特点 ， 运 动 足 曲 崩 和 轮 式 设计 使 其 既 有 腿 式 机 需 人 适应 
地 形 能 力 强 、 机 身 有 灵活 的 优点 ， 又 有 轮 陈 机 器 人 机 动 速度 快 、 机 体 平 衡 控 制 能 力 强 的 优点 。 

2) 利用 锥 齿轮 避免 了 电动 机 直接 承受 径 同 负载 , 提高 了 电动 机 的 使 用 寿命 , 增 大 了 力 窍 。 


© 
































































































































大 学 生 课 外 科技 创新 竞赛 获奖 作品 精 析 





3) 运动 吓 足 展演 轮 的 斜率 设计 , 可 使 得 机 器 人 在 横向 侧 行 步 态 时 腿 部 弯曲 的 角度 恰好 使 深 
轮 厦 地 点 与 地 面相 切 ， 可 实现 多 种 步 态 行 走 ， 可 适用 于 六 趾 、 八 足 等 偶数 足 机 右 人 腿 部 设计 。 

附 图 说 明 

附 图 六 1 为 节 胶 机 器 人 的 轮 腿 式 运动 足 单 足 设计 示意 图 。 

附 图 六 2 为 和 及 机 磊 人 的 轮 腿 却 运 动 足 单 足 设 计 主 视图 。 

附 图 3 为 节 及 机 磊 人 的 轮 腿 却 运 动 足 单 足 谈 计 堪 视图 。 

附 图 4 为 节 及 机 磊 人 的 轮 腿 却 运 动 足 单 足 谈 计 伤 视图 。 

附 图 -S 为 节 及 机 需 人 的 轮 腿 却 运 动 足 双 足 组 合 设计 儿 配 图 。 

附 图 I-6 为 下 及 机 器 人 的 轮 腿 了 式 运 动 足 步 态 设计 图 一 。 

附 图 I-7 为 下 及 机 器 人 的 轮 腿 式 运 动 足 步 态 设计 图 二 。 

附 图 I-8 为 下 及 机 器 人 的 轮 腿 了 式 运 动 足 步 态 设 计 图 三 。 

以 上 附 图 中 : 1 一 文 架 ，2 一 锥 齿轮 ，3 一 轴承 ;4 一 1 号 艇 机 ;5 一 套 简 ; 6 一 1 号 轴 ， 7 一 
身 板 ; 8 一 键 ; 9 一 螺钉 ;10 一 腿 前 部 曲 臂 ，11 一 轴承 ;12 一 和 鹏 机 文 撑 架 一 ;，13 一 2 号 艇 机 ; 14 
一 轴 冰 ;1$ 一 和 能 机 支撑 架 一 ，16 一 能 机 文 撑 架 三 ; 17 一 3 吕 肯 机 ，18 一 能 机 文 撑 架 五 ;19 一 稻 
机 支撑 架 六 ; 20 一 4 号 能 机 ;21 一 轮子 外 套 ;， 22 一 轮 芯 ; 23 一 卡 短 ，24 一 缓冲 热 ，25 一 揪 板 ; 
26 一 直流 电动 机 ; 27 一 电动 机 文 染 ; 28 一 衣 机 文 撑 架 六 ; 29 一 租 机 支撑 染 二 ; 30 一 衣 机 支撑 
染 七 ; 31 一 腿 后 部 曲 句 ，32 一 模板 ，33 一 和 胡 机 支撑 架 二 ; 34 一 嵌 母 ，35 一 此 机 支撑 架 四 。 

具体 实施 方式 

如 附 图 三 1 所 示 ， 为 节 胶 机 器 人 的 轮 腿 式 运 动 足 单 足 设计 示意 图 ， 包 括 连接 板 上 部 的 1 
号 和 能 机 和 连接 板 下 部 的 2 号 、3 写 、4 写 艇 机 ， 以 及 底部 的 直流 电动 机 。 衣 机 包围 结构 有 : 通 
过 螺钉 回 连 的 1 写 衣 机 4 的 文 架 、 锥 齿轮 、 轴 厌 、1 号 轴 和 用 于 与 下 方 结构 连接 的 连接 极 7， 
以 上 机 构 组 合 实现 将 1 号 骨 机 的 水 平 旋转 运动 转化 为 亚 和 直方 同 的 旋转 运动 。2 号 骨 机 13 通过 
时 钉 固 连 四 个 能 机 文 撑 架 ， 实 现 曲 臂 关节 垂直 方 回 的 旋转 。3 号 胡 机 17 通过 螺 杀 固 连 四 个 胡 
机 文 撑 巢 ， 实 现 曲 臂 关节 王 直 方 癌 的 旋 园 。4 号 艇 机 20 通过 螺钉 固 连 四 个 有 机 文 撑 架 ， 实 现 
曲 臂 关节 下 方 轮 足 水 平方 向 的 旋转 。 曲 臂 设 计 结 构 有 : 腿 前 部 曲 臂 10 和 腿 后 部 曲 避 31 分 别 
固 连 2 号 、3 号 衣 机 的 两 侧 艇 机 文 架 ,中间 用 模板 固定 。 轮 式 结构 设计 有 : 用 直流 电动 机 外 腕 
固定 直流 电动 机 ， 插 入 插 板 固定 ， 后 套 入 卡 短 和 便 橡 胶 材 质 缓冲 垫 ， 前 部 套 入 轮 世 ， 闭 轮子 
外 套 21， 实 现 轮 式 行 走 。 

如 附 图 2 所 示 ， 可 看 到 采用 垂直 理念 的 腿 前 部 曲 臂 设 计 ， 运 动 足 足 底 滚 轮 的 斜 这 设 计 ， 
可 使 得 机 器 人 在 横 问 侧 行 步 态 时 腿 部 要 曲 的 角度 恰好 使 浚 轮 独 地 点 与 地 面相 切 。 

如 附 图 王 3、I-4 所 示 ，1 写 衣 机 通过 一 和 号 轴 与 下 部 相连 ,避免 了 电动 机 轴 直 接 承 受 径 问 载 
人 向， 提高 了 电动 机 的 使 用 寿命 。 

如 附 图 三 5 所 示 ， 安 装运 动 呈 时 ， 先 将 衣 机 支撑 架 一 12、 骨 机 支撑 架 二 33、 舵 机 文 撑 架 三 
16 螺钉 固 连 ， 放 入 2 写 骨 机 13 后 用 此 机 文 撑 架 四 35 通过 曙 钉 固 连 ， 实 现 曲 臂 关 节 符 直方 同 的 
旋转 。 再 放 入 3 号 舵 机 17 后 ， 通 过 为 一 组 骨 机 支撑 染 一 15、 骨 机 支撑 架 二 29、 骨 机 支撑 架 五 
18、 舵 机 文 撑 架 三 16 固定 3 号 艇 机 17， 通 过 螺钉 固 连 ， 实 现 曲 臂 关 节 垂 直方 向 的 旋转 。 再 将 腿 
前 部 曲 臂 10 和 腿 后 部 曲 臂 31 分 别 固 连 2 号 鹏 机 13、3 号 艇 机 17 的 两 侧 舵 机 支架 ,中间 用 横 板 
32 固定 。 骨 机 文 撑 架 五 18、 骨 机 文 撑 架 六 19、 骨 机 支撑 架 六 、 和 骨 机 支撑 七 30 通过 螺钉 固定 4 
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号 舵 机 20， 实 现 曲 臂 关 节 下 方 轮 足 水 平方 同 的 旋转 。 后 用 直流 电动 机 外 壳 固 定 直流 电动 机 26， 
插入 插 板 25 回 定 ， 后 套 入 卡 短 23 和 便 橡 胶 材 质 绥 剖 垫 24， 后 部 套 电 动机 延伸 套 ， 前 部 套 入 轮 
蕊 22， 装 轮子 外 套 21。 这 样 实现 了 三 个 舵 机 为 主动 自由 度 和 一 个 直流 电动 机 为 主动 自由 度 的 组 
装 。 与 此 过 程 类 似 ， 完 成 另 一 四 上 自由 度 腿 部 组 装 后 ， 通 过 一 个 连接 平板 可 连接 两 部 分 机 构 ， 在 
驼 机 文 撑 架 四 上 部 通过 轴承 与 连接 板 相 连 ， 连 接 板 上 部 通过 文 架 用 螺钉 固定 1 号 艇 机 ， 后 用 锥 
齿轮 吗 合 1 号 轴 , 1 号 轴 通 过 轴承 连接 2 号 能 机 。 这 样 就 可 以 实现 单 运 动 足 五 个 主动 自由 度 ， 双 
足 连 接 十 个 主动 目 由 度 的 运动 足 组 装 。 利 用 1 号 轴 通 过 连接 板 上 的 孔 插入 轴承 内 图， 实现 将 1 
写 舵 机 的 水 平 旋 转运 动 转化 为 垂直 方 辣 的 旋转 运动 ， 避 免 了 电动 机 轴 直 接 承 受 径 辐 载荷， 提高 
了 电动 机 的 使 用 寿命 ， 同 时 连接 板 下 3 个 骨 机 的 布置 为 腿 部 的 侧 癌 摆动 提供 了 更 强 的 动力 。 

如 附 图 I-6 所 示 ， 实 现 了 轮 腿 式 运动 足 步 态 设计 一 ， 类 螃蟹 式 步 态 。 通 过 控制 2 号 舵 机 转 
动 75”、3 号 盘 机 转动 13” 实现 此 步 态 。 

如 附 图 I-7 所 示 ， 实 现 了 轮 腿 式 运动 足 步 态 设计 二 ， 蹲 时 式 步 态 。 通 过 控制 2 号 舵 机 转动 
75”，3 号 舵 机 转动 73” 实 现 此 步 态 。 

如 附 图 I-8 所 示 ， 实 现 了 轮 腿 式 运动 足 步 态 设计 三 ， 狗 仆 式 步 态 。 通 过 控制 1 号 舵 机 转动 
90”、2 写 舵 机 转动 15”，3 号 艇 机 转动 30” 实现 此 步 态 。 

说 明 书 附 图 



































附 图 [1 节 胶 机 袁 人 的 轮 腿 式 运 动 足 单 足 设计 示意 图 
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附 图 IC2 和 节 胶 机 堪 人 的 轮 腿 式 运动 足 单 足 设计 主 视图 附 图 3 市 上 机 如 人 的 轮 腿 式 运动 中 单 是 设计 
左 视图 








附 图 [4 节 胶 机 袁 人 的 轮 腿 式 运 动 足 单 足 设计 作 视 图 
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附 图 7 区 及 机 喜人 的 轮 腿 式 运 动 足 步 态 设 计 网 二 。 附 图 I8 市 版 机 各 人 的 轮 腿 式 运动 足 步 态 设 计 图 三 
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外 骨骼 穿戴 式 健身 与 康复 机 专利 


专利 名 称 : 外 骨骼 穴 戴 式 健身 与 康复 机 
发 明 人 : 罗 庆 生 ; 辆 宝 玲 ; 赵 欣 驰 ; 冯 达 ; 罗 甚 辉 ， 曹 虹 蚁 ， 吕 金 科 ; 赵 维 展 


外 骨骼 穿戴 式 健身 与 康复 机 


技术 领域 

本 发 明 涉 及 一 种 健身 与 康复 器 材 ， 有 具体 涉及 一 种 外 肯 骼 罕 戴 式 健身 与 康复 机 ， 属 于 机 电 
设备 技术 领域 。 

背景 技术 

现代 生活 法 尚 健 康 ， 运 动 健 和 映 在 健康 生活 中 必 不 可 少 。 随 着 人 们 生活 水 平 的 提高 ， 去 健 
号 房 锋 炼 已 经 成 为 一 种 时 尚 。 特 别 是 对 青年 男女 来 说 ， 拥 有 健壮 有 力 的 肌肉 或 优美 盏 条 的 身 
材 ， 往 往 是 其 梦 续 以 求 的 目标 。 如 今 ， 在 市 场 上 可 以 购 得 的 健身 器 械 基本 分 为 两 大 类 : 重 物 
类 健身 器 与 弹性 元 件 类 健身 器 。 前 者 以 哑铃 、 杠 铃 及 框架 达 引 健身 器 为 代表 ， 哑 铃 、 杠 铃 尽 
管 价 格 低廉 ， 但 用 其 可 以 得 到 锻炼 的 人 体 部 位 却 往往 有 限 多 半 属 于 一 机 一 用 ， 而 且 缺 乏 保 护 
作用 。 框 架 卒 引 健身 器 尽管 更 加 专业 ， 而 且 可 以 对 哑铃 无 法 锻炼 到 的 部 位 进行 弥补 ， 但 往往 
体积 大 ， 价 格 高 ， 非 一 般 家 庭 所 适用 。 尤 其 应 当 指 出 的 是 ， 重 物 类 健 喘 器 有 其 特别 的 劣势 ， 
即 往往 需要 上 百 公 厂 配套 的 金属 重 物 。 这 在 运输 与 安装 过 程 中 ， 是 极其 不 便 的 。 弹 性 元 件 类 
健 喘 器 小 巧 轻便 ， 且 按 去 了 累 效 的 重 物 ， 有 其 一 定 的 优势 ， 但 由 于 其 运动 阻力 往往 为 变 力 ， 
日 其 阻力 大 小 与 人 体 肢 端 位 移 的 变化 关系 缺乏 人 体 构造 学 上 的 科学 匹配 规律 ， 往 往 不 为 专业 
的 健身 人 群 所 接受 。 以 上 两 类 健身 器 ， 均 有 其 不 可 弥补 的 次 并 。 

专利 [94101481.9] 是 一 种 多 功能 健 喘 器 ， 其 结构 组 成 主要 是 由 知 干 文 杆 纵横 交错 连接 成 文 
架 本 体 ， 在 主 竖 文 杆 前 方 的 前 文 杆 设 有 折 和 有 登 式 座 椅 及 一 组 勾 持 横 杆 ， 后 竖 杆 与 奋 干 滑轮 配合 ， 
绳索 绕 设 及 配 重 块 构成 重力 装置 ， 在 主 竖 文 杆 上 端 饮 接 有 导 引 连 杆 ， 在 导 引 连 杆 下 端 设 有 一 
组 踏板 装置 并 连接 重力 装置 的 绳索 构成 运动 在 导 引 连 杆 内 侧 设 有 弧 形 导轨 ， 再 辅 以 施 力 握 杆 
和 套装 。 用 本 装置 可 进行 多 功能 的 健身 运动 。 经 资料 查阅 可 知 : 该 健身 器 仍 以 传统 的 重 物 作 
为 施 力 狼 置 ， 运 动 过 程 中 缺乏 你 护 作 用 ， 在 运输 与 安装 过 程 中 ， 极 其 不 便 。 并 晶 重 物 提供 的 
阻力 大 小 与 人 体 脐 端 位 移 的 变化 关系 缺乏 人 体 构 造 学 上 的 科学 死 配 规律 ， 不 科学 。 而 且 该 健 
身 器 没有 机 身 调整 功能 ， 只 能 适应 一 定 身 高 和 体型 的 小 部 分 人 群 ， 适 用 范围 小 ， 整 个 装置 占 
用 空间 偏 大 ， 由 此 可 见 其 浆 端 。 

发 明 内 容 

有 鉴于 此 ， 本 发 明 提 供 了 一 种 外 骨骼 穿戴 式 健身 与 康复 机 ， 集 健 吴 与 康复 功能 为 一 体 ， 
并 能 适应 不 同 号 高 的 人 和 群 。 

本 友 明 的 外 骨骼 罕 戴 式 健 喘 与 康复 机 包括 肢体 模块 和 验 干 模块 ， 上 肢体 模块 包括 两 个 手 部 
模块 和 两 个 脚 部 模块 ， 其 中 两 个 手 部 模块 沿 典 干 模 块 的 竖 直 中 心 线 左右 对 称 ， 两 个 脚 部 模块 
沿 驱 干 模块 竖 直 中 心 线 左 右 对 称 。 

手 部 模块 包括 第 一 动力 模块 、 第 二 动力 模块 、 第 三 动力 模块 、 大 臂 管 和 手 部 伸 长 部 件 ， 
其 中 大 臂 管 为 直角 结构 。 
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第 一 动力 模块 包括 基 座 A、 舵 机 A、 骨 机 B、 圆 柱 齿 轮 A、 圆 柱 齿 轮 B、 轴 BB、 轴承 座 B、 欠 
齿轮 A、 锥 齿轮 B、 轴 承 座 A 和 轴 A。 其 连接 关系 为 : 基 座 A 为 双 层 台阶 式 结构 ， 骨 机 A 通过 回 
定 在 基 座 A 的 上 层 表 面 。 锥 齿轮 A 与 艇 机 A 的 输出 轴 国 接 ， 其 中 锥 齿轮 A 的 轴线 处 于 竖 和 直方 问 。 
锥 齿轮 A 和 轴线 与 其 垂直 的 锥 齿轮 B 咕 合 。 锥 具 轮 B 与 轴 A 固 接 ， 轴 A 位 于 舵 机 A 的 正 下 方 ， 
即 轴 A 动力 输出 的 方 回 为 水 平 辐 后 。 轴 A 通过 轴承 与 轴承 座 A 配合 ， 轴 承 座 A 与 基 座 A 连接 。 
轮机 B 固定 在 基 座 A 的 下 层 表面 上 上， 圆柱 齿轮 A 与 骨 机 B 的 输出 轴 连 接 ， 圆 柱 齿 轮 A 与 圆柱 此 
轮 B 路 合 ， 其 中 圆柱 齿轮 A 和 圆柱 齿轮 B 的 轴线 均 处 于 竖 直方 向 。 圆柱 齿轮 A 与 轴 B 连接 , 轴 B 
动力 输出 的 方向 为 竖 直 癌 下 。 轴 也 通过 轴承 与 轴承 座 B 配合 ， 轴 承 座 B 固定 在 基 座 A 上 。 

第 二 动力 模块 包括 基 座 B、 艇 机 C、 圆 柱 齿 轮 C、 圆 柱 齿 轮 D、 轴 C 和 轴承 座 C。 其 各 部 
分 的 连接 关系 为 : 艇 机 C 固定 在 基 座 B 上, 圆柱 齿轮 C 固定 在 艇 机 C 的 输出 轴 上 ， 圆 柱 齿轮 D 
与 圆柱 齿轮 C 吗 合 ,其 中 图 柱 齿轮 C 和 圆柱 齿轮 D 的 轴线 均 处 于 竖 直 方 癌 。 圆 柱 齿 轮 D 与 轴 C 
固 接 ， 轴 C 的 竖 直 癌 下 输出 动力 。 轴 CC 通过 轴承 与 轴承 座 C 配合 ， 轴 承 座 C 固定 在 基 座 B 上 。 

第 三 动力 模块 包括 基 座 C、 舵 机 D、 锥 齿轮 C、 锥 齿轮 D、 轴 D 和 轴承 座 D， 其 各 部 分 
的 连接 关系 为 : 艇 机 了 D 固定 在 基 座 C 的 上 表面 ， 锥 齿轮 C 与 衣 机 DD 的 输出 轴 国 接 ， 其 中 锥 齿 
轮 C 的 轴线 处 于 竖 直 方向 。 锥 齿轮 C 和 轴线 与 其 王 直 的 锥 齿轮 D 路 合 ， 锥 齿轮 D 与 轴 D 加 
接 ， 轴 D 位 于 能 机 D 的 正 下 方 ， 即 轴 D 水 平 癌 后 输出 动力 。 轴 D 同时 通过 轴承 与 轴承 座 D 
配合 ， 轴 承 通 过 轴承 座 新 与 轴承 座 D 压 紧 ， 轴 承 座 DD 固定 在 基 座 C 下 表面 。 

手 部 伸 长 部 件 包 括 小 臂 大 套 管 、 锁 祭 调 位 机 构 A、 小 辟 直 管 、 小 臂 折 区 管 、 手 柄 了 管 、 
手柄 旋转 轴 、 手 柄 分 又 和 手柄 套 管 。 其 各 部 分 的 连接 关系 为 : 小 臂 大 套 管 为 和 角 结 构 ， 其 竖 
直 部 分 的 问 部 通过 锁 紧 调 位 机 构 A 与 小 臂 和 直 管 连接 ， 小 臂 直 管 的 另 一 器 通过 和 埋 角 过 管 与 小 辟 
折 膏 管 连接 。 小 臂 折 弯 管 的 另 一 端 和 轴线 与 其 竺 直 的 手柄 工 管 连接 。 手 柄 工 管 的 上 端 连 接手 
柄 分 又 ， 手 柄 分 叉 为 U 形 结构 ， 手 柄 分 叉 的 左右 两 端 之 间 安 装 手 柄 必 管 ， 手 柄 必 管 外 套装 橡 
胶 制 的 手柄 套 管 。 手 柄 必 管 的 两 个 端面 分 别 安 厂 有 手柄 端 盖 。 手 柄 旋转 轴 和 套装 在 手柄 工 管 内 。 
在 手柄 分 又 与 手柄 工 管 的 连接 处 ， 手 柄 分 又 与 手柄 旋转 轴 连 接 。 

锁 紧 调 位 机 构 A 的 具体 结构 为 : 小 臂 大 套 管 和 小 臂 直 管 通过 松紧 环 锁 楷 扣 连 接 在 一 起 ， 
在 小 臂 大 套 管 内 部 与 小 臂 直 管 的 连接 端 有 两 个 相对 安 钱 的 花 型 松紧 环 ， 在 小 臂 直 管 上 和 小 臂 
大 套 管 的 连接 端 安装 有 沉 头 螺钉 ， 沉 头 螺钉 的 螺钉 头 未 完全 沉 入 管 壁 ， 即 沉 头 螺钉 在 管 辟 上 
有 则 起 。 同 时 在 小 辟 大 套 管 的 内 壁 加 工 有 与 沉 头 螺钉 上 的 凸 起 相对 应 的 直 槽 。 

手 部 模块 的 整体 连接 关系 为 : 手 部 伸 长 部 件 中 小 臂 大 套 管 水 平 部 分 的 端 部 与 第 一 动力 模 
块 中 轴 B 的 动力 输出 问 和 连接， 第 一 动力 模块 中 轴 A 的 动力 输出 问 与 大 臂 管 的 一 端 连接 ， 大 名 
管 的 另 一 端 与 第 二 动力 模块 中 轴 C 的 动力 输出 端 连接 。 第 三 动力 模块 中 轴 D 的 动力 输出 并 与 
第 二 动力 模块 的 基 座 连接 ， 第 三 动力 模块 驱动 第 二 动力 模块 整体 转动 。 

脚 部 模块 包括 第 四 动力 模块 、 第 五 动力 模块 、 第 六 动力 模块 、 第 七 动力 模块 、 大 腿 管 、 脚 部 
伸 长 部 件 和 足 部 部 件 。 其 中 大 腿 管 为 直角 结构 。 第 四 动力 模块 与 第 一 动力 模块 结构 相同 ， 第 六 动 
力 模块 与 第 三 动力 模块 结构 相同 。 第 五 动力 模块 与 第 七 动力 模块 均 和 第 二 动力 模块 结构 相同 。 

脚 部 伸 长 部 件 包 括 小 腿 大 套 管 、 小 腿 直 管 、 锁 紧 调 位 机 构 B 和 小 腿 底 端 连接 件 。 其 中 锁 紧 调 
位 机 构 B 与 锁 紧 调 位 机 构 A 的 结构 相同 。 小 腿 大 套 管 竖 直 部 分 的 问 部 通过 锁 紧 调 位 机 构 B 与 小 腿 
直 管 连接 ， 小 腿 和 直 管 的 另 一 喘 与 小 腿 底 问 连 接 件 相 连 。 足 部 部 件 包 括 足 部 座 、 塑 料 板 和 橡胶 垫 。 
其 中 足 部 座 竖 直 放 置 ， 塑 料 板 和 橡胶 热 均 水 平 放置 ， 足 部 座 与 塑料 板 连接 ， 塑 料 板 与 橡胶 垫 连接 。 
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脚 部 模块 的 整体 连接 关系 为 : 中 部 部 件 中 中 部 座 的 顶部 与 第 五 动力 模块 的 动力 输出 轴 连 
接 ， 第 五 动力 模块 的 基 座 与 脚 部 伸 长 部 件 中 的 小 腿 压 端 连 接 件 相连 。 小 腿 大 套 管 水 平 部 分 的 
闹 部 与 第 四 动力 模块 的 竖 直 动力 输出 轴 连 接 ， 第 四 动力 模块 的 水 平 动力 输出 轴 与 大 腿 管 的 一 
闹 连 接 ， 大 民 省 的 力 一 并 与 第 七 动力 模块 的 动力 输出 轴 连 接 。 第 六 动力 模块 的 动力 输出 轴 与 
第 七 动力 模块 的 基 座 连接 ， 第 六 动力 模块 驱动 第 七 动力 模块 整体 转动 。 

左 干 模块 包括 丑 部 基板 、 肩 部 基板 和 运动 机 构 。 避 部 基 极 和 屑 部 基板 位 于 同一 坚 直 和 面 内 ， 
悄 部 基板 位 于 辟 部 基板 上 方 。 屑 部 基板 的 对 称 轴 与 辟 部 基板 的 对 称 轴 重 合 。 所 述 运 动机 构 在 
该 对 称 轴 的 左右 两 边 对 称 布 置 。 

右 侧 运动 机 构 包 括 和 能 机 了 E、 连 杆 A、 连 杆 B、 连 杆 C、 连 杆 D、 大 套 盘 、 承 重 套 杆 、 艇 机 
F、 承 重 杆 、 传 动 轴 、 心 轴 、 丝 杆 、 请 块 、 电 动机 和 大 套 盘 转动 撑 杆 。 其 中 连 杆 C 为 半圆 形 结 
构 ， 该 半圆 形 结 构 的 对 称 线 治水 平方 向 ， 连 杆 C 有 三 个 饮 接 靖 ， 分 别 位 于 半圆 形 结构 的 顶部 、 
底部 及 外 圆周 ， 其 中 外 圆周 上 的 贸 接 器 位 于 其 水 平 对 称 线 的 位 置 。 连 杆 D 为 直角 结构 ， 该 下 
角 结 构 水 平 部 分 的 闹 部 有 坚 且 问 下 的 连接 轴 。 

其 连接 关系 为 : 舵 机 卫 通过 丑 部 基板 下 端的 艇 机 固定 染 固 定 在 辟 部 基板 上 ， 衣 机 E 的 输 
出 轴 垂 和 直 穿 过 臂 部 基板 后 与 连 杆 A 连接 ,该 连接 点 记 为 A 扩 。 连 杆 A 的 为 一 妆 与 连 杆 B 动 连 
接 ， 该 连接 点 记 为 B 点 。 连 杆 B 的 为 一 问 与 连 杆 C 外 圆周 上 的 贸 接 器 动 连接 ， 该 连接 点 记 为 
C 点 。 连 杆 C 诬 部 的 饮 接 冰 通 过 轴承 与 辟 部 基板 连接 ， 该 连接 点 记 为 D 点 ， 其 中 轴承 的 转动 
方向 垂直 与 辟 部 基板 。 保 证 依次 连接 A 点 、B 点 、C 点 、D 点 后 形成 平行 四 边 形 结构 。 连 杆 C 
顶部 的 匀 接 端 为 柱 形 结构 ， 连 杆 C 顶部 的 匀 接 冰 与 连 杆 D 水 平 部 分 站 部 的 连接 轴 治 该 连接 轴 
的 轴线 方 辣 贸 接 。 连 杆 D 紧 直 部 分 上 器 的 外 侧 固定 能 机 上 下， 能 机 下 的 输出 轴 垂 下 于 连 杆 D 的 
坚 直 部 分 。 骨 机 下 的 输出 轴 通 过 传动 轴 与 承重 杆 A 连接 ， 承 重 杆 A 与 承重 套 杆 表面 的 请 槽 配 
合 ， 相 互 只 能 沿 滑 权 方 同 运 动 。 承 重 僚 杆 通 过 已 轴 安 疲 在 局 部 基板 上 ， 蕊 轴 的 安装 方式 为 : 
在 屑 部 基板 左 侧 加 工 有 大 套 枪 的 安 闵 筷 ， 大 套 枪 的 圆心 所 在 水 平 线 局 于 艇 机 的 输出 轴 水 平 
状态 时 的 轴线 位 置 。 大 套 盘 在 其 安装 了 筷 内 与 肩 部 基板 动 连接 ， 大 套 盘 只 能 沿 其 轴 问 转动 。 在 
大 套 盘 上 加 工 有 心 轴 的 安装 孔 ， 设 该 安 闭 扎 所 在 氮 为 上 点 。 心 轴 在 其 安装 扎 内 与 大 套 盘 动 连 
接 ， 且 蕊 轴 只 能 沿 其 轴 问 转动 ， 承 重 套 杆 左 侧 站 部 与 心 轴 固 接 。 丝 杆 安 状 在 位 于 屑 部 基板 对 
称 轴 上 的 丝 杆 安装 槽 肉 ， 滑 块 安装 在 丝 杆 上 ， 滑 块 与 丝 杆 配合 ， 可 治 丝 杆 上 下 移动 ， 丝 杆 项 
部 与 电动 机 的 输出 轴 相 连 。 大 套 盘 转动 撑 杆 的 一 病 与 大 套 盘 连接 ， 设 该 连接 点 为 上 后 ， 丸 一 
峭 与 请 块 连接 。 所 述 上 点 和 王 点 的 连 线 经 过 大 套 盘 的 圆心 。 由 于 远 侧 育 部 运动 机 构 和 右 侧 背 
部 运动 机 构 的 承重 套 杆 在 习 部 基板 的 上 交叉 安 装 ， 为 了 保证 两 边 的 运动 机 构 互 不 干涉 ， 堪 侧 
背部 运动 机 构 的 承重 僚 杆 则 通过 肩 部 跨越 件 与 位 于 经 杆 右 侧 屑 部 基板 上 的 蕊 轴 连 接 。 

本 发 明 整 体 连接 关系 为 :两 个 手 部 模块 分 别 通过 各 目 第 三 动力 模块 的 基 座 固 接 在 红 干 模 
块 中 屑 部 基板 的 左右 两 侧 ， 两 个 脚 部 模块 分 别 遂 过 各 目 第 六 动力 模块 的 基 座 固 接 在 肛 干 模块 
中 辟 部 基 极 的 左右 两 人 出， 两 个 手 部 模块 、 两 个 脚 部 模块 及 驱 干 模 岂 间 的 运动 相互 独立 。 

当 滑 块 位 于 丝 杆 的 最 项 痢 时 ， 所 述 E 点 和 下 点 分 别 位 于 大 侠 盘 水 平方 巾 直 径 的 两 响 ， 其 
中 下 点 位 于 靠近 丝 杆 的 一 侧 。 当 请 块 位 于 丝 杆 的 最 底 端 时， 所 述 卫 点 和 下 扩 分 列 位 于 大 套 栓 
坚 和 直方 同 直 径 的 两 端 ， 其 中 下 点 位 于 E 扣 下 方 。 

所 述 轴 B、 轴 A、 轴 C 和 轴 D 均 为 花 轴 ; 为 了 适应 足 部 伸 长 机 构 ， 所 述 第 五 动力 模块 和 
第 七 动力 模块 中 的 动力 输出 轴 为 贺 轴 ， 能 够 承受 更 大 的 力 。 
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附录 


所 述 轴 了 B 和 轴 A 的 旋转 范围 均 为 150°。 

所 述 所 有 舵 机 的 型 号 均 为 RX-24F， 所 述 所 有 基 座 均 采 用 狐 金 结构 。 

在 小 臂 直 管 上 安装 沉 头 螺钉 的 位 置 沿 其 外 圆周 面 加 工 止 槽 ， 当 小 臂 直 管 皖 入 后 ， 通 过 小 
臂 大 套 管 上 的 观察 孔 观 察 凹 模 的 位 置 ， 进 而 判断 小 臂 直 管 在 小 臂 大 套 管 内 的 相对 位 置 。 

在 小 腿 直 管 上 安装 沉 头 螺钉 的 位 置 治 其 外 圆周 面 加 工 止 槽 ， 当 小 腿 直 管 皖 入 后 ， 可 以 通 
过 小 腿 大 套 管 上 的 观察 孔 观察 止 槽 的 位 置 进而 判断 小 腿 直 管 在 小 腿 大 套 管内 的 相对 位 置 。 

所 述 锥 齿轮 A 到 锥 齿轮 B 的 传动 比 为 1:2。 圆柱 齿轮 A 到 圆柱 齿轮 B 的 传动 比 为 1:2。 
柱 齿轮 C 到 圆柱 齿轮 D 的 传动 比 为 1:2。 锥 齿轮 C 到 锥 齿轮 D 的 传动 比 1:2。 

本 发 明 的 工作 原理 为 : 

本 发 明 的 整体 有 22 个 自由 度 ， 分 别 为 肩 部 四 个 、 上 和 臂 旋 转 两 个 、 肘 两 个 、 膀 四 个 、 大 腿 
旋转 两 个 、 膝 两 个 、 脚 腊 两 个 ， 腰 问 前 后 两 个 及 腰 癌 左右 两 个 ， 通 过 这 22 个 自由 度 可 以 分 别 
独立 地 实现 四 胶 及 躯干 的 各 种 运动 ， 同 时 通过 两 种 不 同 的 工作 模式 分 别 实现 健 身 和 康复 功能 。 
在 运动 过 程 中 手 部 模块 、 脚 部 模块 和 骤 干 模块 中 的 各 个 运动 间 相互 独立 。 

使 用 时 ， 首 先 依次 调整 手 部 模块 、 脚 部 模块 及 躯干 模块 的 长 度 ， 以 适应 健身 人 员 的 号 高 
条 件 。 手 部 模块 的 长 度 直 接 通过 手 部 伸 长 部 件 调整 ， 脚 部 模块 的 长 度 直 接 通 过 脚 部 伸 长 部 件 
调整 。 在 进行 驱 干 模块 长 度 调整 时 ， 丑 部 基板 的 位 置 不 变 ， 通 过 调节 缘 部 基板 的 相对 位 置 来 
适应 健身 或 康复 人 员 的 身高 ， 使 背部 基板 的 顶部 与 健身 或 康复 人 员 的 肩 部 平 齐 。 具 体 调 节 方 
式 为 : 电动 机 驱动 丝 杆 转动 ， 滑 块 治 丝 杆 上 下 移动 ， 进 而 通过 大 套 盘 转动 撑 杆 带动 大 套 盘 转 
动 ， 并 使 肩 部 基板 在 竖 直 方向 上 移动 ， 进 而 实现 肩 部 基板 与 臂 部 基板 之 间距 离 的 调节 。 

在 进行 健 号 或 康复 时 ， 分 别 将 手 和 脚 放 在 手柄 套 管 和 足 部 部 件 上 ， 通 过 背部 基板 顶部 的 
音 带 将 该 健身 与 康复 机 的 正面 与 人 体 的 腰 背 部 贴 合 。 其 中 ， 导 部 基板 对 应 与 人 体 辟 部 位 置 ， 
肩 部 基板 对 应 与 人 体 背 部 ， 背 部 基板 的 顶部 与 健身 或 康复 人 员 的 肩 部 平 齐 。 

在 健身 模式 下 ， 健 身 人 员 依据 自 己 的 需要 对 自己 身体 的 某 个 部 位 进行 锻炼 ， 在 锻炼 时 ， 
相应 自由 度 处 的 能 机 产生 一 个 阻力 矩 ， 健 喘 人 员 根 据 阻力 施加 反方 问 作 用 力 ， 从 而 得 到 健身 
效果 ， 当 健 喘 人员 施加 的 作用 力 大 于 能 机 的 力矩 时 ， 能 机 自动 卸载 。 

在 康复 模式 下 ， 康 复 人 员 依据 自 己 的 需要 对 自己 身体 的 某 个 部 位 进行 康复 ， 在 康复 训练 
时 ， 相 应 自由 度 处 的 能 机 产生 一 个 力矩 ， 带 动 康复 人 员 相 应 位 置 的 关节 活动 ， 通 过 使 关节 被 
动 活动 来 恢复 其 功能 。 

有 益 效 果 : 

1) 本 发 明 集 依据 人 体 肯 骼 结构 进行 设计 ， 健 身 和 康复 功能 与 一 体 ， 实 现 对 人 体 各 个 部 位 
的 锻炼 和 人 体 康复 牵引 。 该 健身 与 康复 机 整体 有 22 个 自由 度 ， 通 过 这 22 个 自由 度 可 以 独立 
实现 人 体 四 肢 及 躯干 部 位 的 多 种 运动 ， 同 时 可 通过 两 种 不 同 的 工作 模式 分 别 实现 健身 和 康复 
功能 ， 从 而 达到 一 机 多 用 的 效果 。 

2) 为 了 使 该 健 喘 与 康复 机 能 够 适应 不 同 喘 高 和 体型 的 人 群 ， 在 手 部 模块 、 脚 步 模块 和 最 
干 模块 中 均 增 加 了 长 度 调整 机 构 ， 使 健身 与 康复 机 的 适用 范围 更 广 。 

3) 在 结构 的 具体 设计 中 ， 第 一 动力 模块 、 第 二 动力 模块 和 第 三 动力 模块 中 的 动力 输出 轴 
均 采 用 花 轴 ， 在 满足 结构 强度 的 同时 ， 能 够 减轻 整个 机 构 的 重量 。 同 时 基体 均 采 用 饭 金 结构 ， 
加 工 简单 ， 重 量 轻 。 

4) 在 小 辟 直 管 ( 小 腿 直 管 ) 上 安装 沉 头 螺钉 的 位 置 处 沿 其 外 圆周 面 加 工 四 槽 ， 可 对 小 臂 
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直 省 (小 腿 直 管 ) 的 位 置 进行 定量 调节 ， 即 对 手 部 伸 出 部 件 ( 脚 部 伸 出 部 件 ) 的 长 上 度 进行 定 
量 调节 。 

5) 整个 装置 采用 模块 化 设计 ， 使 制造 与 维护 更 加 方便 。 

附 图 说 明 

附 图 二 1 为 本 发 明 的 整体 结构 示意 图 。 

附 图 二 2 为 手 部 模块 的 结构 示意图 。 

附 图 二 3 为 本 发 明 第 一 动力 模块 的 结构 示意 图 一 。 

附 图 二 4 为 本 发 明 第 一 动力 模块 的 结构 示意 图 二 。 

附 图 厅 5 为 本 发 明 第 一 动力 模块 的 结构 示意 图 三 。 

附 图 二 6 为 本 发 明 第 二 动力 模块 的 结构 示意 图 一 。 

附 图 二 7 为 本 发 明 第 二 动力 模块 的 结构 示意 图 二 。 

附 图 本 8 为 本 发 明 第 三 动力 模块 的 结构 示意 图 一 。 

附 图 J-9 为 本 发 明 第 三 动力 模块 的 结构 示意 图 二 。 

附 图 于 10 为 手 部 伸 长 部 件 的 机 构 示 意图 。 

附 图 二 11 为 锁 紧 调 位 机 构 A 的 结构 示意 网 。 

附 图 天 12 为 脚 部 模块 的 结构 示意 图 。 

附 图 于 13 为 脚 部 伸 长 部 件 的 结构 示意 图 。 

附 图 矿 14 为 足 部 部 件 的 结构 示意 图 。 

附 图 天 15 为 了 干 模块 背面 的 结构 示意 网 。 

附 图 天 16 为 也 和 干 模块 正面 的 结构 示意 网 。 

其 中 : 1 一 第 一 动力 模块 ;2 一 第 二 动力 模块 ;3 一 第 三 动力 模块 ;4 一 手 部 伸 长 部 件 ，5 一 
大 尽管 ，6 一 饭 金 基体 A、7 一 饭 金 座 A; 8 一 饭 金 座 B;，9 一 艇 机 A; 10 一 舱 机 B; 11 一 圆柱 此 
轮 A; 12 一 圆柱 齿轮 B; 13 一 轴 B; 14 一 轴承 座 B; 15 一 锥 齿轮 A; 16 一 锥 齿轮 B; 17 一 轴承 
座 A; 18 一 轴 A;，19 一 饭 金 基体 B; 20 一 饭 金 座 C; 21 一 饭 金 座 D; 22 一 艇 机 C; 23 一 圆柱 齿 
轮 C; 24 一 圆柱 齿轮 D; 25 一 轴 C; 26 一 轴承 座 C; 27 一 饭 金 基板 C; 28 一 和 能 机 D; 29 一 狼 齿 
轮 C; 30 一 锥 齿轮 D; 31 一 轴 D; 32 一 轴承 座 D; 33 一 小 辟 大 套 管 ，34 一 锁 紧 调 位 机 构 A; 35 
一 小 辟 直 管 ，36 一 小 恬 折 区 省 ， 37 一 手柄 省 ; 38 一 手柄 旋转 轴 ; 39 一 手柄 分 又 ;40 一 手柄 
套 管 ; 41 一 松紧 环 锁 紧 扣 ; 42 一 花 型 松紧 环 ;， 43 一 沉 头 螺钉 ，44 一 凹 槽 ，4$ 一 直 槽 ，46 一 第 
四 动力 模块 ，47 一 第 五 动力 模块 ; 48 一 第 六 动力 模块 ; 49 一 第 七 动力 模块 ， 50 一 脚 部 伸 长 部 
件 ; 51 一 大 腿 管 ，$2 一 足 部 部 件 ，53 一 小 腿 大 套 管 ，5$4 一 小 腿 和 直 管 ， 5$5 一 锁 款 调 位 机 构 B; 56 
一 小 腿 底 端 连 接 件 ，$7 一 足 部 饭 金 座 : $8 一 塑料 板 : 59 一 橡胶 热 ，60 一 臂 部 基板 : 61 一 盘 机 
国定 架 ; 62 一 和 能 机 了 ;63 一 连 杆 A; 64 一 连 杆 B; 65 一 连 杆 C; 67 一 疹 盖 A; 68 一 屑 部 基板; 
69 一 丝 杆 ; 70 一 丝 杆 问 僚 A; 71 一 丝 杆 端 僚 B; 72 一 电动 机 ; 73 一 大 套 盘 ; 74 一 承重 套 杆 ;75 
一 舵 机 F; 76 一 承重 杆 A; 77 一 套 盘 座 ;，78 一 必 轴 端 盖 :， 79 一 传动 轴 ; 81 一 连 杆 D; 82 一 大 
套 盘 转动 撑 杆 ，83 一 肩 部 跨越 件 。 

具体 实施 方式 

下 面 结合 以 上 附 图 并 举 实 施 例 ， 对 本 发 明 进行 详细 描述 。 

本 实施 例 提 供 一 种 外 骨骼 穿戴 式 健身 与 康复 机 ， 该 装置 模拟 人 体 的 外 骨骼 ， 同 时 具备 健身 与 
康复 训练 的 双重 功能 。 该 装置 的 机 身 具备 长 度 调节 功能 ， 能 够 适应 不 同 身 高 的 人 群 ， 适 用 范围 广 。 
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本 发 明 的 外 骨 散 罕 戴 式 健身 与 康复 机 的 整体 结构 如 附 图 厂 1 所 示 , 该 健身 与 康复 机 包括 胶 
体 模块 和 有 最 干 模 块 。 肢 体 模块 包括 两 个 手 部 模块 和 两 个 脚 部 模块 ， 其 中 两 个 手 部 模块 沿 园 干 
模块 的 竖 直 中 心 线 左右 对 称 ， 两 个 脚 部 模块 沿 绒 干 模 块 竖 直 的 中 心 线 左右 对 称 。 

手 部 模块 的 结构 如 附 图 厂 2 所 示 ， 包 括 第 一 动力 模块 1、 第 二 动力 模块 2、 第 三 动力 模块 

、 大 臂 管 $ 和 手 部 伸 长 部 件 4， 其 中 大 臂 管 $ 为 直角 结构 。 

第 一 动力 模块 1 的 结构 如 附 图 J-3、 附 图 天 4 和 附 图 JS$ 所 示 。 第 一 动力 模块 1 包括 饭 金 
基体 A6、 饭 金 座 A7、 饭 金 座 B8、 骨 机 A9、 舵 机 B10、 圆 柱 齿 轮 Al11， 圆 柱 齿轮 B12、 轴 
B13、 轴 承 座 B14、 锥 齿轮 A15、 锥 齿轮 B16、 轴 承 座 A17 和 轴 Al18。 第 一 动力 模块 1 有 两 路 
输出 ， 两 路 输出 间 相 互 独立 。 动 力 输出 轴 分 别 为 轴 B13 和 轴 A18， 输 出 方式 为 旋转 ， 旋 转 范 
围 均 为 130” 。 轴 B13 的 驱动 件 为 能 机 B10, 轴 Al8 的 张 动 件 为 能 机 A9。 在 本 实施 例 中 轴 B13 
和 轴 A18 均 为 花 轴 ， 在 满足 强度 要 求 的 同时 能 够 减轻 第 一 动力 模块 1 的 质量 。 

第 一 动力 模块 1 各 部 分 的 连接 关系 为 : 饭 金 基体 A6、 饭 金 座 A7 和 饭 金 座 B8 之 间 通 过 螺 
栓 连 接 形成 动力 模块 的 基 座 ， 为 了 保证 第 一 动力 模块 1 结构 紧凑 且 其 两 路 输出 间 互 不 干涉 ， 
所 形成 的 基 座 为 双 层 台阶 式 结 构 。 所 述 舵 机 A9 通过 六 个 M2 螺钉 固定 在 基 座 的 上 层 表 面 。16 
齿 的 M1 锥 齿轮 A15 与 舵 机 A9 的 码 盘 连接 ， Se A15 的 轴线 处 于 竖 直 方 同 。 同 时 ， 
锥 齿轮 A15 和 轴线 与 其 垂直 的 32 齿 M1 锥 齿轮 B16 员 合 。 锥 齿轮 B16 通过 六 个 M2 螺钉 与 轴 
Al8 固 接 ， 轴 A18 位 于 艇 机 A9 的 正 下方 ， 即 轴 A18 动力 答 出 的 方向 为 水 平 向 后 。 轴 Al8 通 
过 两 个 6002Z 轴承 与 轴承 座 A17 配合 , 轴承 座 A17 通过 四 个 M3 螺钉 与 基 座 连接 。 当 舵 机 A9 
输出 动力 时 ， 动 力 通过 嘴 合 的 锥 齿轮 A15 和 锥 齿轮 B16 传递 到 轴 A18， 传 动 比 为 1:2。 骨 机 
B10 通过 四 个 M3 螺栓 固定 在 基 座 的 下 层 表 面 上 ，13 具 的 M2 圆柱 齿轮 All 通过 六 个 M2 螺 
钉 与 舵 机 B10 的 码 盘 连接 ， 圆 柱 齿 轮 All 与 26 齿 的 M2 圆柱 齿轮 B12 吵 合 ， 其 中 圆柱 齿轮 
All 和 圆柱 齿轮 B12 的 轴线 均 处 于 竖 直 方向 。 圆 柱 齿 轮 Al1l 通过 螺钉 与 轴 B13 连接 ， 轴 B13 
动力 输出 的 方向 为 竖 直 向 下 。 轴 B13 通过 两 个 6002Z 轴承 配合 在 轴承 座 B14 上 ， 轴 承 座 B14 
通过 四 个 M3 贬 杀 固定 在 基 座 上 。 骨 机 B10 旋转 输出 动力 时 ， 动 力 通 过 圆柱 齿轮 All 以 及 圆 
柱 齿 轮 B12 传递 到 轴 B13， 传 动 比 为 1:2。 

第 二 动力 模块 2 的 结构 如 附 图 J-6 和 附 图 本 7 所 示 ， 第 二 动力 模块 2 包括 饭 金 基体 B19、 
饭 金 座 C20、 饭 金 座 D21、 舵 机 C22、 圆 柱 齿 轮 C23、 圆 柱 齿 轮 D24、 轴 C25 和 轴承 座 C26。 
第 二 动力 模块 2 有 一 个 输出 ， 动 力 输出 轴 为 轴 C25， 原 动 件 为 艇 机 C22， 其 中 轴 C25 为 花 轴 。 

第 二 动力 模块 2 各 部 分 的 连接 关系 为 : 饭 金 基体 B19、 饭 金 座 C20 和 饭 金 座 D21 通过 
M3 螺栓 连接 形成 第 二 动力 模块 2 的 基 座 。 衣 机 C22 通过 四 个 M3 螺栓 固定 在 基 座 上 ,13 具 的 
M2 圆柱 齿轮 C23 Se M2 螺钉 直接 连接 在 能 机 C22 的 码 盘 上 ,26 贞 的 M2 圆柱 齿轮 D24 
与 圆柱 齿轮 C23 路 合 ， 其 中 圆柱 齿轮 C23 和 圆柱 齿轮 D24 的 轴线 均 处 于 竖 直 方 同 。 圆 柱 齿 轮 
D24 通过 六 个 M2 螺钉 国定 在 轴 C25 的 一 闫 ， 轴 C25 的 另 一端 竖 百 癌 下 输出 动力 。 轴 C25 通 
过 两 个 6002Z 轴承 与 轴承 座 C26 配合 , 轴承 座 C26 通过 四 个 M3 螺钉 与 基 座 固定 。 当 舵 机 C22 
输出 动力 时 , 动力 通过 圆柱 齿轮 C23 传递 到 圆柱 齿轮 D24, 再 通过 轴 C25 输出 , 传动 比 为 1:2。 

第 三 动力 模块 3 的 结构 如 附 图 -8 和 附 图 厂 9 所 示 ， 第 三 动力 模块 3 包括 饭 金 基板 C27、 
轮机 D28、 锥 齿轮 C29、 锥 齿轮 D30、 轴 D31 和 轴承 座 D32。 第 三 动力 模块 3 有 一 个 输出 ， 
动力 轴 为 轴 D31， 原 动 件 为 衣 机 D28， 其 中 轴 D31 为 花 轴 。 

第 三 动力 模块 3 各 部 分 的 连接 关系 为 : 饭 金 基板 C27 为 第 三 动力 模块 3 的 基 座 ， 舵 机 D28 
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通过 六 个 M2 螺钉 固定 在 饭 金 基板 C27 的 上 表面 , 16 齿 的 M1 锥 齿轮 C29 通过 六 个 M2 螺钉 与 骨 
机 D28 的 码 盘 固定 ， 其 中 锥 齿轮 C29 的 轴线 处 于 竖 直 方向 。 锥 齿轮 C29 和 轴线 与 其 垂直 的 32 具 
M1 锥 齿轮 D30 中 合 ， 锥 齿轮 D30 通过 六 个 M2 螺钉 与 轴 D31 一 端 固 接 ， 轴 D31 位 于 舵 机 D28 
的 正 下 方 , 即 轴 D31 动力 输出 的 方 癌 为 水 平 问 后 。 轴 D31 同时 通过 两 个 6002Z 轴承 与 轴承 座 D32 
配合 ， 轴 承 通 过 轴承 座 盖 与 轴承 座 D32 压 紧 ， 轴 承 座 D32 通过 六 个 M3 螺钉 固定 在 饭 金 基板 C27 
下 表面 。 当 胡 机 D28 输出 动力 时 , 动力 通过 锥 齿轮 C29 和 锥 齿轮 D30 传递 到 轴 D31, 传动 比 1:2。 

在 本 实施 例 中 ， 以 上 三 个 动力 模块 使 用 的 能 机 型 号 均 为 RX-24F。 

手 部 伸 长 部 件 4 的 结构 如 附 图 二 10 所 示 ， 包 括 小 臂 大 套 管 33、 锁 紧 调 位 机 构 A34、 小 辟 
直 管 33$、 小 臂 折 人 这 管 36、 手 柄 工 管 37、 手 柄 旋转 轴 38、 手 柄 分 又 39 和 手柄 套 管 40。 其 各 部 
分 的 连接 关系 为 : 小 臂 大 套 管 33 为 直角 结构 ， 其 竖 直 部 分 的 问 部 通过 锁 又 调 位 机 构 A34 与 小 
辟 直 管 35 连接 ， 小 臂 直 管 35 的 男 一 端 通过 直角 弯 管 与 小 辟 折 弯 管 36 连接 。 小 臂 折 弯 管 36 
的 另 一 端 和 轴线 与 其 垂直 的 手柄 TT 管 37 连接 。 手 柄 工 管 37 的 上 端 连 接手 柄 分 又 39， 手 柄 分 
又 39 为 TU 形 结 构 ， 手 柄 分 又 39 的 左右 两 端 之 间 安 装 手柄 心 管 ， 手 柄 忌 管 外 套装 橡胶 制 的 手 
柄 套 管 40。 使 用 时 ， 手 部 握 住 手 柄 套 管 40， 可 增强 舒适 性 。 手 柄 芯 管 的 两 个 端面 分 别 安 装 有 
手柄 庙 盖 。 手 柄 旋转 轴 38 通过 两 个 聚 四 氟 乙烯 润滑 套套 闭 在 手柄 工 管 37 内 。 在 手柄 分 又 39 
与 手柄 工 管 37 的 连接 处 ， 手 柄 分 又 39 通过 M4 长 螺钉 与 手柄 旋转 轴 38 连接 。 

锁 紧 调 位 机 构 A34 的 结构 如 附 图 厂 11 所 示 ， 其 体 结构 为 : 小 臂 大 套 管 33 和 小 臂 直 管 35 
通过 松紧 环 锁 紧 扣 41 连接 在 一 起 , 在 小 辟 大 套 省 33 内 部 与 小 辟 直 管 35 的 连接 端 有 两 个 相对 
安装 的 花 型 松紧 环 42， 花 型 松紧 环 42 松 开 时 ， 便 可 调整 小 臂 大 套 管 33 和 小 臂 直 管 35 的 相对 
位 置 。 花 型 松紧 环 42 拧紧 时 则 会 提供 大 摩擦 力 锁 紧 小 辟 大 套 管 33 和 小 臂 直 管 35。 在 小 辟 直 
管 35 上 和 小 臂 大 套 管 33 的 连接 端 安装 M3 的 沉 头 螺钉 43， 沉 头 螺钉 43 的 螺钉 头 未 完全 沉 入 
管 壁 ， 有 大 约 1mm 的 突出 ， 同 时 在 小 臂 大 套 管 33 的 内 部 有 与 沉 头 螺钉 43 相对 应 的 直 档 45， 
在 小 辟 直 管 35 装 入 小 辟 大 套 管 33 后 ， 并 未 完全 沉 入 的 沉 头 螺钉 43 与 直 槽 45 配合 形成 约束 ， 
防止 小 臂 大 套 管 33 和 小 臂 直 管 35 转动 ， 辅 助 花 型 松紧 环 42 实现 周 辣 锁 紧 。 此 外 ， 为 了 对 小 
尽 直 管 35 的 位 置 进 行 定量 调节 ， 还 可 在 在 小 臂 直 管 3$ 上 安装 沉 头 螺钉 43 的 位 置 沿 其 外 圆周 
面 加 工 凹 槽 44， 当 小 臂 直 管 3$ 拧 入 后 ,可 以 通过 小 辟 大 套 管 33 上 的 观察 孔 观察 凹 槽 44 的 位 
置 进 而 判断 小 臂 直 管 35 在 小 臂 大 套 管 33 内 的 相对 位 置 。 

手 部 模块 的 整体 连接 关系 如 附 图 二 2 所 示 : 手 部 伸 长 部 件 4 中 小 臂 大 套 管 33 水 平 部 分 的 
疹 部 与 第 一 动力 模块 1 中 轴 B13 的 动力 输出 端 连接 ， 第 一 动力 模块 1 中 轴 A18 的 动力 输出 端 
与 大 臂 管 5 的 一 问 连 接 ， 大 臂 管 $ 的 另 一 问 与 第 二 动力 模块 2 中 轴 C25 的 动力 输出 问 连 接 。 
第 三 动力 模块 3 中 轴 D30 的 动力 输出 端 与 第 二 动力 模块 2 的 基 座 连接 ， 第 三 动力 模块 3 驱动 
第 二 动力 模块 2 整体 转动 。 

脚 部 模块 的 结构 如 附 图 厂 12 所 示 ， 包括 第 四 动力 模块 46、 第 五 动力 模块 47、 第 六 动力 模 
块 48、 第 七 动力 模块 49、 大 腿 管 S1、 脚 部 伸 长 部 件 50 和 足 部 部 件 52。 其 中 大 腿 管 51 为 直 
角 结 构 。 第 四 动力 模块 46 与 第 一 动力 模块 1 结构 相同 ， 第 六 动力 模块 48 与 第 三 动力 模块 3 
结构 相同 。 为 了 适应 足 部 伸 长 机 构 ， 第 五 动力 模块 47 中 的 动力 得 出 轴 为 圆 轴 ， 其 余 结 构 均 与 
第 二 动力 模块 2 相同 。 第 七 动力 模块 49 与 第 五 动力 模块 47 结构 相同 。 

脚 部 伸 长 部 件 50 的 结构 如 附 图 大 13 所 示 ， 包 括 小 腿 大 套 管 S3、 小 腿 直 管 54、 锁 紧 调 位 
机 构 B55 和 小 腿 底 端 连接 件 56。 其 中 锁 紧 调 位 机 构 B55 与 锁 紧 调 位 机 构 A34 的 结构 相同 。 小 
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腿 大 套 管 53 竖 直 部 分 的 端 部 通过 锁 紧 调 位 机 构 B55 与 小 腿 直 管 54 连接 , 小 腿 直 管 54 的 另 一 
并 与 小 腿 底 问 连 接 件 56 相连 。 足 部 部 件 为 健身 或 康复 人 员 脚 部 站 立 的 位 置 。 足 部 部 件 的 结构 
如 附 图 二 14 所 示 , 包括 足 部 饭 金 座 57、 塑料 板 58 和 橡胶 热 $9。 其 中 足 部 饭 金 座 57 竖 直 放置 ， 
塑料 板 58 和 橡胶 热 59 均 水 平 放 置 ， 足 部 饭 金 座 57 通过 其 底部 的 螺钉 与 塑料 板 50 连接 ， 塑 
料 板 50 通过 螺钉 与 橡胶 热 51 连接 。 其 中 ， 足 部 饭 金 座 57 是 足 部 部 件 的 核心 ， 起 主要 的 支撑 
及 与 其 他 模块 的 连接 作用 ， 塑 料 板 58 主要 起 辅助 文 撑 及 减 震 的 作用 ， 橡 胶 垫 59 可 以 减 震 及 
保护 地 板 ， 防 止 硬 质 材 料 损伤 木 地 板 等 。 

脚 部 模块 的 整体 连接 关系 为 : 足 部 部 件 中 足 部 饭 金 座 57 的 顶部 与 第 五 动力 模块 47 的 动力 输 
出 轴 连 接 ， 第 五 动力 模块 47 的 基 座 与 脚 部 伸 长 部 件 50 中 的 小 腿 底 端 连 接 件 56 相连 。 小 腿 大 套 管 
53 水 平 部 分 的 问 部 与 第 四 动力 模块 46 的 竖 直 动力 输出 轴 连 接 ， 第 四 动力 模块 46 的 水 平 动力 输出 
轴 与 大 腿 管 51 的 一 应 连接 ， 大 尽管 51 的 男 一 剖 与 第 七 动力 模块 的 动力 输出 轴 连 接 。 第 六 动力 模 
块 的 动力 输出 轴 与 第 七 动力 模块 的 基 座 连接 ， 第 六 动力 模块 驱动 第 七 动力 模块 整体 转动 。 

躯干 模块 的 整体 结构 如 附 图 J-15 和 附 图 厂 16 所 示 。 和 最 干 模 块 包括 辟 部 基板 60、 肩 部 基 
板 68 和 运动 机 构 。 避 部 基板 60 和 肩 部 基板 68 位 于 同一 坚 直面 内 ， 房 部 茹 板 68 位 于 有 辟 部 基 
板 60 上 方 。 肩 部 基板 68 的 对 称 轴 与 臂 部 基板 60 的 对 称 轴 重 合 ， 所 述 运动 机 构 在 该 对 称 轴 的 
左右 两 边 对 称 布置 ， 下 面 仅 以 右 侧 运动 机 构 为 例 有 具体 介绍 其 结构 。 

石 侧 运 动机 构 包 括 舱 机 E62、 连 杆 A63、 连 杆 B64、 连 杆 C65、 连 杆 D81、 大 套 盘 73、 承 
重 套 杆 74、 艇 机 F7$、 承 重 杆 、 传 动 轴 、 芯 轴 、 丝 杆 69、 滑 块 、 电 动机 72 和 大 套 盘 转动 撑 杆 
82。 其 中 连 杆 C65 为 半圆 形 结构 ， 该 半圆 形 结构 的 对 称 线 治 水 平方 向 ， 连 杆 C65 有 三 个 贸 接 
问 ， 分 别 位 于 半圆 形 结构 的 项 部 、 确 部 及 外 圆周 ， 其 中 外 圆周 上 的 饺 接 问 位 于 其 水 平 对 称 线 
的 位 置 。 连 杆 D81 为 直角 结构 ， 该 直角 结构 水 平 部 分 的 端 部 有 竖 直 辐 下 的 连接 轴 。 

轮机 E62 通过 M2.5 螺钉 固定 在 位 于 辟 部 基板 60 上 的 能 机 固定 架 61 的 左 侧 ， 舵 机 E62 的 
输出 轴 通 过 M2 螺钉 与 连 杆 A63 相连 , 连 杆 A63 的 另 一 端 通过 M5 长 螺栓 及 润滑 热 片 与 过 村 B64 
动 连接 ， 连 杆 B64 的 另 一 端 通 过 M5 长 螺栓 及 润滑 垫上 请 与 连 杆 C65 外 圆周 上 的 贸 接 端 连接 。 在 
辟 部 基板 60 上 艇 机 固定 架 61 上 方 加 工 有 内 部 承重 轴 的 安装 扎 。 辟 部 承重 轴 通 过 两 个 SKF615 
轴承 安装 在 该 安装 孔 内 ， 辟 部 承重 轴 的 一 端 与 连 杆 C65 底部 的 饮 接 端 固 连 ， 另 一 端 穿 过 辟 部 基 
板 60 与 辟 部 轴承 座 动 连接 ， 民 部 轴承 座 通 过 M3 螺钉 固定 在 辟 部 基板 60 上 。 辟 部 承重 轴 与 辟 
部 轴承 座 连 接 的 一 端 同时 通过 M4 螺钉 与 端 盖 A67 固 连 , 可 防止 辟 部 承重 轴 轴 向 移动 。 连 杆 C65 
顶部 的 饺 接 端 与 背部 系统 相连 。 连 杆 C65 顶部 的 贸 接 端 通过 润滑 套 与 连 杆 D81 上 的 连接 轴 沿 该 
连接 轴 的 轴线 方 回 贸 接 。 同 时 连 杆 D81 上 的 连接 座 通过 M4 螺钉 与 端 辣 A67 固 连 ， 防 止 连 杆 
D81 轴 问 滑动 。 连 杆 D81 竖 直 部 分 的 上 问 外 侧 固 定 有 能 机 F75， 艇 机 F75 的 输出 轴 通 过 M2 螺 
钉 与 传动 轴 固 连 ， 传 动 轴 通 过 M5 长 螺钉 及 键 与 承重 杆 A76 连接 ， 承 重 杆 A76 套装 在 承重 套 杆 
74 表面 的 滑 棍 内 ， 从 而 形成 一 个 滑 权 结构， 相互 只 能 沿 滑 覃 方向 运动 。 在 肩 部 基板 68 上 丝 杆 
69 的 左 侧 加 工 有 大 套 盘 73 的 安装 孔 ， 大 套 盘 73 位 于 该 安装 孔 内 ， 大 套 盘 的 圆心 所 在 水 平 线 高 
于 艇 机 下 的 输出 轴 水 平 状态 时 的 轴线 位 置 。 同 时 大 套 盘 73 的 另 一 端 罕 过 习 部 基板 68 并 通过 润 
滑 套 与 套 柱 座 77 动 连接 ， 套 盘 座 77 通过 M3 螺钉 与 肩 部 基板 68 固 连 。 在 大 套 盘 73 上 加 工 有 
心 轴 的 安装 和 孔 ， 设 该 安 逆 筷 所 在 点 为 E 点 ， 心 轴 通 过 润滑 人 套 安 装 在 安装 和 孔 内 ， 并 与 大 套 税 73 动 
连接 。 心 轴 的 一 端 与 承重 僚 杆 74 的 问 部 连接 ， 男 一 亲 容 过 大 套 检 73 通过 M4 螺钉 与 必 轴 冰 盖 
78 固 连 ， 防 止 芯 轴 的 轴 向 移动 。 在 肩 部 基板 68 竖 直 中 心 线 上 加 工 有 丝 杆 安装 模 ， 丝 杆 69 通过 
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其 顶部 的 丝 杆 端 套 A70 和 底部 的 丝 杆 端 套 B71 竖 直 安装 在 丝 杆 安装 模 内 , 丝 杠 端 套 A70 和 丝 杠 
端 套 B71 的 外 圆周 分 别 安装 有 轴承 和 轴承 座 ， 所 述 轴承 座 通过 M3 螺钉 固定 在 肩 部 基板 68 上 。 
滑动 块 安装 在 丝 杆 69 上 ， 清 动 块 与 丝 杆 69 配合 ， 可 沿 丝 杆 69 上 下 移动 ， 电 动机 72 的 输出 轴 
与 丝 杆 69 的 顶部 相连 .大 套 盘 转动 撑 杆 82 的 一 端 通过 M4 螺钉 及 润滑 热 片 与 大 套 盘 73 动 连接 ， 
设 该 连接 点 为 F 点 , 大 套 盘 转动 撑 杆 82 的 另 一 端 通过 与 滑动 件 动 连接 , 所 述 F 点 和 了 点 的 连 线 
经 过 大 套 盘 的 圆心 。 且 有 当 滑 块 位 于 丝 杆 的 最 顶端 时 ， 所 述 了 点 和 下 点 分 别 位 于 大 套 盘 水 平 直 
径 的 两 端 ， 其 中 下 点 位 于 靠近 丝 杆 的 一 侧 ， 当 滑 块 位 于 丝 杆 的 最 底 端 时 ， 所 述 卫 点 和 了 点 分 别 
位 于 大 套 盘 竖 直 直径 的 两 端 ， 其 中 F 点 位 于 EE 点 下 方 。 

由 于 左 部 运动 机 构 和 右 部 运动 机 构 的 承重 套 杆 在 肩 部 基板 68 上 交叉 安装 ， 为 了 保证 两 边 
的 运动 机 构 互 不 干涉 ， 右 部 运动 机 构 的 承重 套 杆 则 通过 肩 部 跨越 件 83 与 位 于 肩 部 基板 68 上 
丝 杆 69 左 侧 的 芯 轴 固 连 。 

本 发 明 整 体 连 接 如 附 图 二 1 所 示 ， 两 个 手 部 模块 分 别 通过 各 自 第 三 动力 模块 的 基 座 固 接 在 
躯干 模块 中 户 部 基板 68 的 左右 两 侧 , 两 个 脚 部 模块 分 别 通过 各 自 第 六 动力 模块 的 基 座 固 接 在 最 
干 模块 中 辟 部 基板 60 的 左右 两 侧 , 两 个 手 部 模块 、 两 个 脚 部 模块 及 躯干 模块 间 的 运动 相互 独立 。 

综 上 所 述 ， 以 上 仅 为 本 发 明 的 较 佳 实施 例 而 已 ， 并 非 用 于 限定 本 发 明 的 保护 范围 。 凡 在 本 发 
明 的 精神 和 原则 之 内 ， 所 作 的 任何 修改 、 等 同 蔡 换 、 改 进 等 ， 均 应 包含 在 本 发 明 的 保护 范围 之 内 。 

说 明 书 附 图 







































































附 图 大 1 本 发 明 的 整体 结构 示意 图 附 图 六 2 手 部 模块 的 结构 示意 图 
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附 图 厂 3 ”本 发 明 第 一 动力 模块 的 结构 示意 图 一 附 图 厂 4 ”本 发 明 第 一 动力 模 岂 的 结构 示意 图 二 





附 图 本 5 ”本 发 明 第 一 动力 模 岂 的 结构 示意 图 三 附 图 J-6 本 发 明 第 二 动力 模块 的 结构 示意 网 一 





附 图 厂 7 本 发 明 第 二 动力 模块 的 结构 示意 图 二 
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附 图 三 8 ”本 发 明 第 三 动力 模 岂 的 结构 示意图 一 附 图 J-9 本 发 明 第 三 动力 模块 的 结构 示意 网 二 





附 图 J11 人 锁 系 调 位 机 构 A 的 结构 示意 图 


附 图 大 12 ” 脚 部 模块 的 结构 示意 图 
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附 图 古 15” 驱 干 模 块 背 面 的 结构 示意 图 附 图 古 16 ” 驱 干 模块 正面 的 结构 示意 图 
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穿戴 式 腰 背部 健身 与 康复 机 


技术 领域 

本 发 明 涉及 一 种 健身 与 康复 器 材 ， 具 体 涉及 一 种 穿戴 式 腰 背 部 健身 与 康复 机 ， 属 于 机 电 
设备 技术 领域 。 

背景 技术 

随 着 社会 节奏 的 加 快 、 工 作 压 力 的 增加 ， 人 们 生活 水 平和 生活 工作 环境 的 改善 ， 腰 背部 
疼痛 的 发 病 率 却 正 以 惊人 的 速度 增长 ， 这 可 能 与 人 们 伏案 工作 时 间 延 长 ， 活 动 减少 及 肥胖 等 
因素 有 关 。 经 调查 ， 腰 背部 疼痛 的 患者 从 20 岁 开 始 骤然 增多 ， 而 且 随 着 年 龄 的 增加 而 上 升 。 
据 统计 世界 上 约 有 21%6 的 人 患 有 不 同 程度 的 腰 背部 疼痛 疾患 。 因 此 非常 有 必要 增加 对 腰 背 音 
的 修炼 ， 从 而 减少 腰 背 部 疼痛 疾患 。 但 如 今 ， 在 市 场 上 可 以 购 得 的 腰 背 部 健身 和 康复 器 城 非 
常 有 限 ， 这 些 器 械 不 仅 种 类 和 功能 单一 ， 而 且 一 台 器 械 针对 的 人 群 非常 狭小 。 另 外 ， 这 些 器 
械 提 供 运动 阻力 大 小 往往 与 人 体 肢 端 位 移 的 变化 关系 缺乏 人 体 构 造 学 上 的 科学 匹配 规律 ， 不 
为 专业 的 健身 人 群 所 接受 。 

[201010244553] 发 明 涉及 一 种 腰部 锻炼 用 运动 器 械 ， 它 包括 如 下 几 个 部 分 : 与 地 面 接触 并 
紧密 结合 的 固定 下 板 ， 在 上 述 固定 下 板 上 侧 设置 的 旋转 上 板 ， 设 置 在 上 述 固定 下 板 的 气缸 上 
部 与 上 述 旋转 上 板 的 导 杆 外 沿 ， 当 用 户 踏 上 旋转 上 板 之 后 ， 上 下 运动 时 产生 弹性 变形 的 压缩 
弹性 构件 ， 在 插入 式 国定 孔 与 插入 式 结合 孔 之 间 至 少 有 一 个 以 上 与 之 相 结合 ， 当 旋转 上 板 沿 
左右 所 动 时 产生 弹性 变形 ， 并 左右 对 称 设置 的 拉 伸 弹性 构件 。 经 资料 查阅 可 知 ， 腰 部 锻炼 用 
运动 器 械 仍 以 传统 的 弹性 元 件 作为 施 力 装置 ， 运 动 过 程 中 缺乏 保护 作用 。 而 传统 的 弹性 元 件 
提供 的 阻力 大 小 与 人 体 肢 端 位 移 的 变化 关系 缺乏 人 体 构造 学 上 的 科学 匹配 规律 ， 不 够 科学 。 
而 且 该 器 械 没 有 机 身 调 整 功能 ， 只 能 适应 一 定 身 高 和 体型 的 小 部 分 人 群 ， 适 用 范围 小 ， 而 整 
个 装置 占用 空间 偏 大 ， 其 弊端 由 此 可 见 。 

发 明 内 容 

鉴于 以 上 因素 ， 本 发 明 提供 一 种 穿戴 式 腰 背部 健身 与 康复 机 ， 能 够 集中 对 人 的 腰 背 部 进 
行 锻炼 或 康复 训练 ， 且 在 装置 中 增加 了 调整 机 构 ， 能 够 适应 不 同 身高 的 人 群 ， 使 健身 或 康复 
更 科学 化 。 

本 发 明 的 腰 背 部 健身 与 康复 机 包括 丑 部 基板 、 肩 部 基板 和 运动 机 构 ， 辟 部 基板 和 肩 部 基 
板 位 于 同一 竖 直 面 内 ， 肩 部 基板 位 于 肚 部 基板 上 方 ， 肩 部 基板 的 对 称 轴 与 肚 部 基板 的 对 称 轴 
重合 ， 所 述 运动 机 构 在 该 对 称 轴 的 左右 两 边 对 称 布置 。 

右 侧 运动 机 构 包 插 能 机 BE、 连 杆 A、 连 杆 B、 连 杆 C、 连 杆 D、 大 套 盘 、 承 重 套 杆 、 通 机 
F、 承 重 杆 、 传 动 轴 、 芯 轴 、 丝 杆 、 滑 块 、 电 动机 和 大 套 盘 转 动 撑 杆 ， 其 中 连 杆 C 为 半圆 形 结 
构 ， 该 半圆 形 结构 的 对 称 线 沿 水 平方 向 ， 连 杆 C 有 三 个 匀 接 端 ， 分 别 位 于 半圆 形 结构 的 顶部 、 
底部 及 外 圆周 ， 其 中 外 圆周 上 的 匀 接 端 位 于 其 水 平 对 称 线 的 位 置 ， 连 杆 D 为 直角 结构 ， 该 直 
角 结 构 水 平 部 分 的 端 部 有 竖 直 向 下 的 连接 轴 。 

其 连接 关系 为 ， 通 机 E 通过 辟 部 基板 下 端的 舵 机 固定 染 固定 在 丑 部 基板 上 ， 和 能 机 E 
的 输出 轴 重 直 穿 过 辟 部 基板 后 与 连 杆 A 连接 ， 该 连接 点 记 为 A 点 ， 连 杆 A 的 另 一 端 与 连 
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杆 B 动 连接 ， 该 连接 点 记 为 B 点 ; 连 杆 B 的 另 一端 与 连 杆 C 外 圆周 上 的 贸 接 端 动 连接 ， 
该 连接 点 记 为 C 点 ; 连 杆 C 底部 的 匀 接 端 通过 轴承 与 辟 部 基板 连接 ， 该 连接 点 记 为 DD 点 ， 
其 中 轴承 的 转动 方向 垂直 与 蔷 部 基板 ; 保证 依次 连接 A 点 、B 点 、C 点 、D 点 后 形成 平行 
四 边 形 结构 ; 连 杆 C 顶部 的 贸 接 端 为 柱 形 结构 ， 连 杆 C 顶部 的 饮 接 端 与 连 杆 D 水 平 部 分 
端 部 的 连接 轴 沿 该 连接 轴 的 轴线 方向 饮 接 ; 连 杆 D 竖 直 部 分 上 端的 外 侧 固定 舵 机 上 ,能 机 
F 的 输出 轴 垂 直 于 连 杆 D 的 竖 直 部 分 ， 舵 机 下 的 输出 轴 通 过 传动 轴 与 承重 杆 A 连接 ， 承 
重 杆 A 与 承重 套 杆 表面 的 滑 槽 配合， 相互 只 能 沿 滑 槽 方向 运动 ， 承 重 套 杆 通 过 芯 轴 安装 
在 肩 部 基板 上 ， 芯 轴 的 安装 方式 为 : 在 肩 部 基板 左 侧 加 工 有 大 套 盘 的 安装 孔 ， 大 套 盘 的 圆 
心 所 在 水 平 线 高 于 能 机 下 的 输出 轴 水 平 状态 时 的 轴线 位 置 ; 大 套 盘 在 其 安装 孔 内 与 肩 部 基 
板 动 连接 ， 大 套 盘 只 能 沿 其 轴 癌 转动 ; 在 大 套 盘 上 加 工 有 必 轴 的 安装 孔 ， 设 该 安装 孔 所 在 
点 为 上 点 ; 世 轴 在 其 安装 孔 内 与 大 套 盘 动 连接 ， 且 芯 轴 只 能 沿 其 轴 疝 转动 ， 承 重 套 杆 左 
侧 端 部 与 芯 轴 固 接 ; 丝 杆 安装 在 位 于 肩 部 基板 对 称 轴 上 的 丝 杆 安装 槽 内 , 滑 块 安装 在 丝 杆 
上 ， 滑 块 与 丝 杆 配合 ， 可 沿 丝 杆 上 下 移动 ， 丝 杆 顶 部 与 电动 机 的 输出 轴 相 连 ， 大 套 盘 转动 
撑 杆 的 一 端 与 大 套 盘 连接 ， 设 该 连接 点 为 了 点 ， 另 一 端 与 滑 块 连接 ;所 述 F 点 和 EE 点 的 
连 线 经 过 大 套 盘 的 圆心 ; 左 侧 运 动机 构 中 的 承重 套 杆 通过 肩 部 跨越 件 与 位 于 肩 部 基板 右 侧 
的 心 轴 连 接 。 

当 滑 块 位 于 丝 杆 的 最 顶端 时 ， 所 述 E 点 和 下 点 分 别 位 于 大 套 盘 水 平 直径 的 两 端 ， 其 中 下 
点 位 于 靠近 丝 杆 的 一 侧 ; 当 滑 块 位 于 丝 杆 的 最 底 端 时 ， 所 述 E 点 和 下 点 分 别 位 于 大 套 盘 竖 直 
直径 的 两 端 ， 其 中 下 点 位 于 E 点 下 方 。 

由 于 左 侧 背部 运动 机 构 和 右 侧 背部 运动 机 构 的 承重 套 杆 在 肩 部 基板 的 上 交叉 安装 ， 为 了 
保证 两 边 的 运动 机 构 互 不 干涉 ， 左 侧 背 部 运动 机 构 的 承重 套 杆 则 通过 肩 部 跨越 件 与 位 于 丝 杆 
右 侧 肩 部 基板 上 的 芯 轴 连接 。 

所 述 舵 机 E 和 艇 机 下 的 型 号 均 为 RX-24F。 

所 述 辟 部 基板 和 肩 部 基板 均 为 饭 金 结构 ， 加 工 简单 ， 重 量 轻 。 

设 以 上 运动 机 构 的 安装 面 为 健身 与 康复 机 的 背面 ， 其 相对 面 为 该 健身 与 康复 机 的 正面 。 
本 发 明 的 运动 原理 为 : 

在 进行 健身 或 康复 之 前 ， 先 依据 健身 或 康复 人 员 的 身高 进行 长 度 的 调节 。 调 节 时 ， 导 音 
基板 的 位 置 不 变 ， 通 过 调节 背部 基板 的 相对 位 置 来 适应 健身 或 康复 人 员 的 身高 ， 使 背部 基板 
的 顶部 与 健身 或 康复 人 员 的 肩 部 平 齐 。 具 体 调 市 方式 为 : 电动 机 驱动 丝 杆 转动 ， 滑 块 治 丝 杆 
上 下 移动 ， 进 而 通过 大 套 盘 转动 撑 杆 带动 大 套 盘 转动 ， 并 使 肩 部 基板 在 竖 直 方向 上 移动 ， 进 
而 实现 肩 部 基板 与 辟 部 基板 之 间距 离 的 调节 。 

在 进行 健身 或 康复 时 ， 先 将 懂 部 基板 固定 ， 通 过 背部 基板 顶部 的 背带 将 该 健身 与 康复 机 
的 正面 与 人 体 的 腰 背 部 贴 合 。 其 中 ， 辟 部 基板 对 应 与 人 体 辟 部 位 置 ， 肩 部 基板 对 应 与 人 体 背 
部 ， 背 部 基板 的 顶部 与 健身 或 康复 人 员 的 肩 部 平 章 。 该 健身 与 康复 机 能 够 完成 前 后 俯仰 运动 
和 左右 运动 ， 由 于 其 为 轴 对 称 结构 ， 下 面 只 针对 左 半边 具体 介绍 其 运动 方式 ， 右 半边 的 运动 
与 其 对 应 。 实 现 左右 运动 时 : 骨 机 EE 带动 连 杆 A 绕 A 点 转动 ， 通 过 连 杆 B 带动 连 杆 C 绕 DD 
点 转动 ， 从 而 实现 腰部 的 左右 运动 。 此 时 ， 通 过 连 杆 D 推动 承重 杆 A 在 承重 套 杆 表面 滑 槽 内 
的 滑动 , 来 补偿 因 腰 部 的 左右 运动 而 引起 C 点 和 D 点 之 间 长 的 度 变 化 。 实现 前 后 俯仰 运动 时 ， 
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直接 通过 舱 机 F 的 转动 带动 肩 部 基板 前 后 运动 ， 由 此 在 肩 部 基板 背面 形成 的 长 度 产 通过 承重 
杆 A 和 承重 套 杆 形成 的 请 动 副 补偿 。 

在 健身 模式 下 ， 骨 机 输出 的 力矩 产生 与 人 身体 施 力 相反 的 力 ， 健 和 叶 人 员 通 过 对 抗 该 阻力 
窍 得 到 健身 效果 ， 由 于 艇 机 输出 的 可 调整 性 ， 可 以 模拟 不 同 的 受 力 状况 ， 当 健 喘 人 员 施 加 的 
作用 力 大 于 骨 机 的 力矩 时 ， 骨 机 上 自动 凶 载 。 

在 康复 模式 下 : 舵 机 带动 康复 人 员 进行 腰 背部 的 左右 及 俯仰 运动 ， 通 过 被 动 活动 来 恢复 
其 功能 。 

有 益 效 末 如 下 : 

1) 集 健 身 与 康复 功能 与 一 体 ， 能 够 进行 腰 背 部 的 前 后 俯仰 运动 和 腰部 的 左右 扭 动 ， 从 而 
实现 腰 背 部 的 锻炼 或 康复 训练 。 

2) 握 弃 了 传统 的 弹性 施 力 装 置 ， 采 用 输出 可 调 的 艇 机 作为 施 力 装 置 ， 艇 机 提供 的 阻力 大 
小 可 依据 健身 或 康复 人 员 的 需要 目 行 调节 ， 从 而 使 锻炼 或 康复 更 科学 。 

3) 背部 系统 具有 长 上 度 调 和 功能 ， 以 适应 不 同 身 高 和 体型 的 人 群 ， 使 得 猜 置 的 适用 范围 三 。 

4) 将 连 杆 C 加 工 成 半圆 形 结构 ， 可 防止 左右 运动 时 两 边 运 动机 构 之 间 形 成 干涉 。 

5) 承重 杆 A 和 承重 套 杆 形 成 的 滑动 副 能 够 保证 在 进行 前 后 傣 仰 运动 时 该 装置 能 够 与 人 体 
背部 的 紧密 贴 合 。 

附 图 说 明 

附 图 K-1 为 该 健身 与 康复 机 背面 的 结构 示意 图 。 

附 图 K-2 为 该 健身 与 康复 机 正面 〈 与 人 体贴 合 面 ) 的 结构 示意 图 。 

附 图 K-3 为 该 健身 与 康复 机 在 进行 长 度 调 节 前 后 的 对 比 图 。 

附 图 K-4 为 前 后 俯仰 运动 时 的 结构 示意 图 。 

附 图 K-5 为 左右 扭 动 时 的 结构 示意 图 。 

其 中 :1 一 辟 部 基板 ; 2 一 能 机 固定 架 ;，3 一 和 能 机 E; 4 一 连 杆 A; 5 一 连 杆 B; 6 一 连 杆 C; 8 一 
端 兰 A; 9 一 肩 部 基板 ;10 一 丝 杆 ;11 一 丝 杆 端 套 A; 12 一 丝 杆 端 套 B; 13 一 电动 机 ，14- 一 大 套 检 ; 
15 一 承重 套 杆 ，16 一 般 机 F; 17 一 承重 杆 A; 18 一 套 盘 座 ，19 一 忆 轴 端 盖 ，20 一 传动 轴 ;， 22 一 连 
杆 D; 23 一 大 套 盘 转动 撑 杆 ，24 一 肩 部 跨越 件 ，25 一 端 盖 B。 

具体 实施 方式 

下 面 结合 以 上 附 图 并 举 实施 例 ， 对 本 发 明 进 行 详 细 描述 。 

本 实施 例 提 供 一 种 罕 戴 式 腰 背部 健 吴 与 康复 机 ， 访 猜 置 模拟 人 体 的 外 骨骼 ， 同 时 具备 健 
吴 与 康复 训练 的 双重 功能 ;该 朔 置 的 机 喘 具 备 长 度 调 节 功 能 ， 能 够 适应 不 同 喘 高 的 人 群 ， 适 
用 范围 广 。 

本 发 明 的 腰 背 部 健身 与 康复 机 整体 结构 如 附 图 K-1 和 附 图 K-2 所 示 。 包 括 辟 部 基板 1、 
肩 部 基板 9 和 运动 机 构 。 其 中 履 部 基板 1 和 肩 部 基板 9 位 于 同一 坚 直 面 内 ， 肩 部 基板 9 位 于 
辟 部 基板 1 上 方 ; 肩 部 基板 9 的 对 称 轴 与 辟 部 基板 1 的 对 称 轴 重 合 ， 运 动机 构 在 该 对 称 轴 的 
左右 两 边 对 称 布置 ， 下 面 仅 以 右 侧 运 动机 构 为 例 ， 有 具体 介绍 其 结构 。 

右 侧 运动 机 构 包 括 能 机 E3、 连 杆 A4、 连 村 B5、 连 杆 C6、 连 杆 D22、 大 套 盘 14、 承 重 
套 杆 13、 舵 机 F16、 承 重 杆 A17、 传 动 轴 、 心 轴 、 丝 杆 10、 滑 块 、 电 动机 13 和 大 套 盘 转动 
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撑 杆 23。 其 中 连 杆 C6 为 半圆 形 结构 ， 该 半圆 形 结构 的 对 称 线 治 水 平方 向 ， 连 杆 C6 有 三 个 
饮 接 端 ， 分 别 位 于 半圆 形 结构 的 项 部、 底部 及 外 圆周 ， 其 中 外 圆周 上 的 饮 接 端 位 于 其 水 平 对 
称 线 的 位 置 。 连 杆 D22 为 直角 结构 ， 该 直角 结构 水 平 部 分 的 端 部 有 竖 直 向 下 的 连接 轴 。 其 
上 其 体 连接 关系 为 : 骨 机 E3 通过 M2.5 螺钉 固定 在 和 能 机 固定 架 2 上 ， 肯 机 E3 的 输出 轴 垂 和 与 
辟 部 基板 1， 艇 机 E3 的 输出 轴 通 过 M2 螺钉 与 连 杆 A4 相连 ， 连 杆 A4 的 另 一 端 通过 M5 长 
曙 栓 以 及 润滑 垫 片 与 连 杆 B5 动 连接 ， 连 杆 B5 的 另 一 端 通过 M5 长 螺栓 以 及 润滑 垫 片 与 连 
杆 C6 外 圆周 上 的 贸 接 端 动 连接 。 在 辟 部 基板 1 上 舵 机 固定 架 2 的 上 方 加 工 有 辟 部 承重 轴 的 
安装 筷 ， 避 部 承 章 轴 通 过 两 个 SKF2215 轴承 安装 在 该 安装 和 孔 内 ， 辟 部 承重 轴 的 一 闹 与 连 杆 
C6 底部 的 饮 接 端 固 接 ， 由 此 形成 平行 四 边 形 的 运动 机 构 。 辟 部 承重 轴 的 另 一 端 罕 过 辟 部 基 
板 1 与 辟 部 轴承 座 动 连接 ， 避 部 轴承 座 通过 M3 螺钉 固定 在 辟 部 基板 1 上 。 辟 部 承重 轴 与 辟 
部 轴承 座 的 连接 端 同 时 通过 M4 螺钉 与 端 盖 A8 固 连 ， 端 盖 A8 可 防止 辟 部 承重 轴 的 轴 向 移 
动 。 连 杆 C6 顶部 的 贸 接 端 通过 润滑 套 与 连 杆 D22 上 的 连接 轴 沿 该 连接 轴 的 轴 向 贸 接 ， 连 杆 
D22 上 的 连接 座 通 过 M4 螺钉 与 端 盖 B 固 连 ， 防 止 连 杆 D22 轴 间 滑动 。 连 杆 D22 竖 直 部 分 
上 端的 外 侧 固 定 有 能 机 F16,， 艇 机 F16 的 输出 轴 竺 直 与 连 杆 D22 的 竖 直 部 分 ; 能 机 16 的 输 
出 轴 与 传动 轴 20 固 连 ， 传 动 轴 通 过 M5 长 螺钉 及 键 与 承重 杆 A17 连接 ， 承 重 杆 A17 安装 在 
承重 套 杆 15 表面 的 滑 槽 内 ， 从 而 形成 一 个 滑动 副 ， 相 互 上 只 能 治 滑 槽 方 癌 运动 。 在 丝 杆 左 侧 
的 肩 部 基板 上 安装 有 大 套 盘 ， 大 套 盘 14 的 圆心 所 在 水 平 线 高 于 舵 机 F16 的 输出 轴 水 平 状态 
时 的 轴线 位 置 ; 大 套 盘 的 轴线 垂直 于 肩 部 基板 。 大 套 盘 14 穿 过 肩 部 基板 9 与 套 盘 座 18 动 连 
接 ， 套 盘 座 18 通过 M3 螺钉 与 习 部 基板 9 固 连 ， 肆 盘 座 18 可 防止 大 套 盘 14 的 轴 问 滑动 。 
在 大 套 盘 14 上 加 工 有 芒 轴 的 安 狼 和 孔 ， 设 该 安装 了 筷 所 在 点 为 E 点; 必 轴 通过 润滑 僚 安 装 在 安 
小 孔 内 ， 并 与 腰部 大 套 盘 14 动 连接 。 必 轴 的 一 端 与 承重 套 杆 15 的 端 部 固 接 ， 另 一 端 穿 过 大 
套 盘 14 通过 M4 螺钉 与 世 轴 端 盖 19 固 连 ， 防 止 芯 轴 的 轴 向 移动 。 在 肩 部 基板 9 对 称 轴 上 加 
工 有 丝 杆 安 钱 槽 ， 丝 杆 10 通过 其 顶部 的 丝 杆 端 套 Al11 和 帮 部 的 丝 杆 端 僚 B12 竖 直 安装 在 丝 
杆 安装 槽 内 ， 丝 杠 端 套 Al11 和 丝 杠 端 套 B12 的 外 圆周 分 别 安装 有 轴承 和 轴承 座 ， 所 述 轴承 
座 通过 M3 螺钉 固定 在 屑 部 基板 9 上 。 滑 块 安装 在 丝 杆 10 上 ， 滑 块 与 丝 杆 10 配合 ， 可 沿 丝 
杆 10 上 下 移动 ， 电 动机 13 的 输出 轴 与 丝 杆 10 的 顶部 相连 。 大 套 盘 转动 撑 杆 23 的 一 端 通过 
M4 螺钉 以 及 润滑 热 片 与 大 套 盘 14 动 连接 ， 设 该 连接 点 为 了 点 ， 另 一 端 通过 与 滑 块 连接 ， 所 
述 F 点 和 E 点 的 连 线 经 过 大 套 盘 14 的 圆心 。 

由 于 左 侧 背部 运动 机 构 和 右 侧 背部 运动 机 构 的 承重 套 杆 在 肩 部 基板 9 上 区 叉 安 朔 ， 为 了 
保证 两 边 的 运动 机 构 互 不 干涉 ， 左 侧 背 部 运动 机 构 的 承重 套 杆 则 通过 肩 部 跨越 件 24 与 位 于 丝 
杆 10 右 侧 肩 部 基板 9 上 的 芯 轴 固 连 。 

在 进行 身高 调节 时 ， 当 滑 块 位 于 丝 杆 10 的 最 顶端 时 ， 所 述 E 点 和 下 点 分 别 位 于 大 套 盘 
14 水 平 直径 的 两 端 ， 其 中 下 点 位 于 靠近 丝 杆 10 的 一 侧 ; 当 滑 块 位 于 丝 杆 10 的 最 底 端 时 ， 上 所 
述 E 点 和 下 点 分 别 位 于 大 套 盘 14 竖 直 直径 的 两 端 ， 其 中 下 点 位 于 卫 点 下 方 。 

综 上 所 述 ， 以 上 仅 为 本 发 明 的 较 佳 实施 例 而 已 ， 并 非 用 于 限定 本 发 明 的 保护 范围 。 凡 在 
本 发 明 的 精神 和 原则 之 内 ， 所 作 的 任何 修改 、 等 同 替 换 、 改 进 等 ， 均 应 包含 在 本 发 明 的 保护 
范围 之 内 。 
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附 图 K-2 该 健身 与 康复 机 正面 《与 人 体贴 合 面 ) 的 结构 示意 图 
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附 图 K-4 前 后 傈 仰 运动 时 的 结构 示意 图 





附 图 K-5 左右 扭 动 时 的 结构 示意 图 
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技术 领域 
本 友 明 属于 智能 家 居 拉 术 应 用 领域 ， 具 体 涉及 一 种 室内 高 处 空间 物品 存放 及 管理 系统 。 
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科学 技术 的 进步 使 人 们 对 生活 品质 有 了 更 高 的 追求 ， 与 此 同时 ， 生 活 节 答 的 日 益 加 快 和 
住房 面积 的 日 趋 紧 张 ， 却 使 人 们 拥有 越 来 越 少 的 时 间 和 空间 对 生活 物品 进行 收纳 放置 和 分 类 
整理 。 据 调查 ， 中 国 普通 住房 室内 高 度 多 在 2.5~3m 之 间 ， 储 物 柜 体 高 度 通 常 只 有 2m， 这 种 
现状 使 屋内 高 处 空 间 浪费 极 大 ， 由 此 带 来 的 居住 人 口 、 存 放 物 品 与 住房 空间 之 则 的 巴 盾 也 越 
来 越 突出 。 查 询 可 知 ， 国 内 目前 尚 没有 一 套 室内 高 处 空间 存放 物品 的 智能 化 装置 系统 ， 而 传 
统 的 高 空 储 物 方 式 只 是 物品 的 简单 堆积 ， 显 得 过 于 低档 ， 不 仪 美观 性 差 ， 物 品 取 放 人 危险 性 也 
高 ， 且 不 便于 查找 ， 储 物 效率 低 ， 难 以 满足 现代 居民 追求 高 品位 生活 的 需求 。 

20 世纪 80 年 代 初 ， 智 能 家 居 的 概念 已 经 被 提出 ， 它 是 以 基本 住宅 为 平台 ， 利 用 综合 布线 技 
术 、 网 络 通信 技术 、 安 全 防范 技术 、 目 动 控制 技术 、 音 视频 技术 将 家 居中 与 生活 有 关 的 设施 集成 ， 
构建 高 效 的 住宅 设施 与 家 庭 日 程 事务 的 管理 系统 ， 来 提升 家 居 安 全 性 、 便 利 性 、 和 舒适 性 、 艺 术 性 。 
我 国 智能 家 居 和 领域 发 展 较 快 ， 但 基于 智能 化 管理 平台 的 针对 室内 物品 分 类 存放 与 取 用 的 装置 或 是 
充分 利用 高 处 空间 的 物品 收纳 装置 却 鲜 有 出 现 ， 同 时 有 具备 以 上 两 种 功能 的 装置 更 是 风 毛 鹿角 。 

四 川 大 学 林 建 辉 等 发 明 的 “同步 带 驱 动 的 自 适应 误差 消除 式 自 动 取 物 装置 ”申请 号 /专利 
号 : 200610020641) 有 三 层 安装 板 ， 板 上 设置 下 料 同 步 禹 驱动 装置 、 伸 绚 装 置 、 翻 转 出 料 和 
目 动 回 绚 装 置 ， 加 装 有 定位 弹 和 和 前 、 后 位 限 位 传 感 右 ， 能 够 日 适应 消除 误 大 ， 底 板 上 安 并 
的 垂直 提升 巢 可 使 该 装置 做 上 下 运动 。 该 闭 置 仅 实 现 了 取 放 物品 ， 机 构 较 为 复杂 独立 ， 并 没 
有 安装 到 物 架 上 ， 人 完全 依赖 压板 上 的 垂直 升降 染 实 现 竖 直 运动 ， 有 取 放 物品 蝇 度 的 限制 ， 并 
且 需 要 人 工 全 程 监控 操作 才 可 完成 全 部 运动 流程 ， 不 能 利用 软件 技术 对 物品 进行 综合 管理 ， 
实现 物品 的 自动 取 放 ， 目 动 化 水 平 较 低 。 

发 明 内 容 

本 发 明 的 目的 在 于 提供 一 种 能 够 提高 室内 衬 间 利用 率 和 储 物 效率 的 高 处 空间 物品 存放 及 
管理 系统 。 上 述 系 统 依托 机 构 与 电路 设计 、 软 件 技术 实现 物品 的 目 动 分 类 存 取 功 能 ， 是 一 种 
集 信 息 的 采集 、 整 合 、 文 配 于 一 体 的 智能 型 机 电 一 体 化 产品 。 为 实现 上 述 发 明 目 的 ， 本 系统 
由 蕊 挂 货架 及 安装 于 蕊 挂 贷 架 上 的 竖 直 升降 涛 置 、 水 平 拖 动 装置 、 储 物 日 元 取 放 装置 ， 耕 干 
储 物 单 元 和 软件 管理 平台 组 成 。 

上 述 晤 挂 货 架 可 用 螺栓 固定 在 室内 局 处 ， 构 成 该 系统 的 基本 框架 ， 晨 挂 贷 架 右 侧 的 两 层 
隅 板 放 置 2 排 3 列 共 6 个 储 物 单 元 ， 在 储 物 单元 内 存放 该 系统 自动 分 类 的 各 种 物品 。 

上 述 竖 直 升 降 钱 置 包括 平板 、 电 动机 工 、 同 步 带 轮 工 、 同 步 带 轮 开 、 同 步 珊 工 、 传 动 轴 、 
耸 线 简 工 、 固 定 轴承 、 齿 轮 、 定 滑轮 工 、 锁 死机 构 、 钢 丝 绳 [、 托 盘 、 清 块 工 和 直线 导轨 工 。 
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附录 











电动 机 工 国定 在 悬挂 货架 左上 方 的 平板 上 ， 同 步 带 轮 工 安 装 在 电动 机 工 的 转轴 上 ， 通 过 哮 合 
同步 带 工 使 同步 带 轮 开 转动 ， 进 而 使 安装 在 国定 轴承 上 的 传动 轴 转 动 ， 降 低 转速 。 钢 丝 绳 I 
的 一 端 固定 在 传动 轴 的 卷 线 简 上 ， 另 一 端 固 定 在 用 于 容纳 储 物 单元 的 托盘 上 ， 依 靠 定 滑轮 
[ 的 导向 作用 ， 将 水 平 运动 转换 成 坚 直 运动 从 而 带动 托盘 升降 。 托 盘 背 部 安装 着 的 两 个 滑 块 
1 ， 可 沿 固定 在 悬挂 货架 后 方 的 两 根 直 线 导轨 工 滑动 ， 以 此 保证 托盘 竖 直 运动 的 平稳 性 。 平 
板 上 还 安装 有 锁 死 机 构 ， 在 系统 断 电 时 将 卡 住 传动 轴 上 的 齿轮 ， 防 止 托盘 在 储 物 单元 及 自身 
重力 下 重力 作用 下 突然 下 滑 伤害 用 户 。 

上 述 水 平 拖 动 装置 包括 平板 、 电 动机 工 、 卷 线 简 开 、 定 滑轮 开 、 钢 丝 绳 开 、 滑 块 工 和 直 
线 导 轨 芽 。 悬 挂 货架 上 层 框架 内 侧 分 布 安装 若干 定 渭 轮 芽 ， 前 方 框架 上 下 各 固定 一 条 直线 导 
轨 ， 电 动机 芽 辕 定 在 平板 上 ， 其 转轴 上 安装 有 卷 线 位 了， 卷 线 简 卫 分 为 两 部 分 ， 分 别 用 于 
收 、 放 钢丝 绳 工 ， 钢 丝 绳 工 依靠 定 滑 轮 开 的 导向 作用 ， 缠 绕 在 悬挂 货架 前 上 方 的 空间 内 ， 可 
带动 储 物 单元 取 放 装置 连接 板 1 和 连接 板 I[L 上 的 滑 块 工 沿 直 线 导 轨 开 作 水 平 运动 。 

上 述 储 物 单元 取 放 装置 包括 电动 机 IIT、 同 步 带 轮 IT、 同 步 带 轮 IV、 同 步 带 开 、 电 动机 IV、 
同步 带 轮 V、 同 步 带 IT、 托 板 、 丝 杜 、 光 杠 工 、 光 杠 开 、 滑 块 工 、 连 接 板 [ 、 连 接 板 I、 连 接 
板 IIT 和 连接 板 IV。 连 接 板 I 与 连接 板 工 用 四 根 光 杠 开 连接 ， 连 接 板 开 和 连接 板 II 用 三 根 穿 过 托 
板 的 光 杠 连接 ， 保 证 该 装置 整体 强度 ， 连 接 板 I 安装 滑 块 下 两 个 ， 连 接 板 II[ 安 装 滑 鼎 工 一 个 ， 
丝 杠 穿 过 托 板 ， 一 端 固 连 在 连接 板 IIT 上 的 轴承 内 ， 另 一 端 通过 同步 带 轮 IIL、 同 步 带 轮 IV、 同 步 
带 开 构成 的 同步 带 机 构 与 安装 在 连接 板 堪 上 的 电动 机 II 连接 ， 电 动机 II[ 转 动 使 丝 杠 旋转 ， 托 板 
上 安装 着 的 与 光 杠 工 慌 套 的 三 个 直线 轴承 可 使 托 板 在 旋转 丝 杠 的 带动 下 做 竖 直 升降 运动 ， 托 板 
下 方 一 侧 贴 在 同步 带 U， 与 安装 在 电动 机 转轴 上 的 同步 带 轮 V 咕 合 ， 电 动机 全 固定 在 托 板 下 
方 ， 该 装置 两 侧 设 有 连接 板 IV， 增 加 装置 强度 。 

上 述 软件 管理 平台 硬件 设施 包括 触摸 屏 、 扫 码 枪 和 条 形 码 打印 机 。 该 硬件 设施 安装 在 县 
挂 货架 下 方 用 户 方便 使 用 处 ， 用 户 在 触摸 屏 上 登录 该 管理 平台 ， 当 存放 物品 时 ， 用 扫 码 枪 对 
物品 扫 码 ， 系 统 自动 取 下 合适 的 储 物 单元 ， 待 用 户 放 入 物品 后 系统 将 其 自动 放 回 ， 若 物品 无 
条 形 码 ， 则 用 户 可 自行 录入 ， 将 打印 机 打印 出 的 条 形 码 贴 在 物品 上 ， 当 取 用 物品 时 ， 用 户 通 
过 触摸 屏 搜索 该 物品 ， 系 统 会 自动 取 下 物品 所 在 的 储 物 单元 ， 用 户 取出 物品 后 系统 将 储 物 单 
元 自动 收回 。 用 户 平常 可 通过 该 平台 了 解 物品 的 存放 日 期 、 存 放 位 置 、 保 质 期 等 详细 信息 ， 
实现 对 存储 物品 的 综合 化 、 智 能 化 管理 。 

本 发 明 与 其 他 技术 相 比 具有 如 下 优点 ; 

1) 本 发 明 结构 简单 ， 占 地 面积 小 ， 可 充分 利用 室内 高 处 空间 ， 运 动 原理 简洁 清晰 ， 自 行 
设计 的 运输 及 存 取 装置 ， 为 物品 的 自动 存 取 提供 机 构 保障 ， 有 效 改 善 家 居 生 活 条 件 。 

2) 本 发 明 融合 机 电 技术 、 软 件 工 程 技术 、 信 息 检索 技术 等 多 项 技术 ， 是 一 种 可 实现 物品 
自动 存 取 功能 的 智能 型 产品 ， 解 决 了 高 处 物品 难以 取 放 的 难题 ， 省 心 省 力 的 同时 增强 了 物品 
存 取 的 便利 性 、 安 全 性 和 美观 性 ， 产 品 的 性 价 比 高 。 

3) 本 发 明 拥有 自主 研发 的 软件 管理 系统 ， 人 机 交互 界面 友好 ， 用 户 可 利用 该 系统 对 物品 
进行 记录 、 检 索 、 分 类 、 查 阅 详细 信息 等 操作 ， 极 大 地 提升 了 储 物 效率 和 生活 品位 。 

附 图 说 明 

附 图 L-1 为 本 发 明 室 内 高 处 空间 物品 存放 及 管理 系统 的 总 体 分 布 图 。 

附 图 L-2 为 本 发 明 室内 高 处 空间 物品 存放 及 管理 系统 的 竖 直 升降 装置 工作 平台 示意 图 。 
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附 图 L-3 为 本 发 明 宇 内 高 处 空间 物品 存放 及 管理 系统 的 水 平 拖 动 儿 置 示意 

附 图 L-4 为 本 发 明 军 内 高 处 空间 物品 存放 及 管理 系统 的 储 物 单 元 取 放 闭 置 示意 

附 图 L-5 为 本 发 明 军 内 高 处 空间 物品 存放 及 管理 系统 的 储 物 单元 取 放 装置 主 视图 。 

附 图 L-6 为 本 发 明 宇 内 高 处 空间 物品 存放 及 管理 系统 软件 管理 平台 的 人 硬件 组 成 示意 岁 。 

上 述 附 图 中 标号 名 称 : 1 一 悬挂 货架 ，2 一 扫 码 枪 ，3 一 条 形 码 打印 机 ，4 一 触摸 屏 ， 5 一 储 物 
单元 ; 6 一 固定 轴承 ;7 一 卷 线 简 工 ，8 一 定 滑 轮 工 ，9 一 平板 ，10 一 传动 轴 ;， 11 一 锁 死 机 构 ; 
12 一 齿轮 ，13 一 电动 机 工 ，14 一 同步 带 轮 工 ;， 15 一 同步 带 轮 [ ，16 一 同步 带 工 ;，17 一 电动 机 工 ; 
18 一 定 滑 轮 工 ;，19 一 钢丝 绳 [ ，20 一 托盘 ，21 一 滑 块 工 ，22 一 直线 导轨 工 ，23 一 直线 导轨 开 ; 
24 一 钢丝 强 卫 ;25 一 卷 线 位 ;26 一 同步 禹 轮 [[[，27 一 光 杠 [28 一 电动 机 I[I，29 一 光 杜 II; 
30 一 丝 杜 ，31 一 托 板 ，32 一 同步 带 轮 人 V，33 一 同步 带 卫 ;34 一 连接 板 [ ，35 一 滑 块 工 ，36 一 连 
接 板 ;37 一 连接 板 I[[; 38 一 电动 机 信 ; 39 一 同步 市 轮 V ; 40 一 同步 市 1; 41 一 连接 板 V。 

具体 实施 方式 

下 面 结合 以 上 附 图 和 具体 实施 对 本 发 明 作 进一步 详细 说 明 : 

附 图 L-1 为 室内 高 处 空间 物品 存放 及 管理 系统 的 总 体 分 布 图 ， 本 发 明 包 括 悬 挂 货 架 及 安 
北 于 惹 挂 货 架 上 的 竖 下 升降 装置 、 水 平 拖 动 装置 、 储 物 单元 取 放 装置 ， 奉 干 储 物 蛙 元 ， 软 件 
管理 平台 组 成 。 上 述 悬 挂 货架 作为 该 系统 的 基本 框 锅 ， 可 用 螺栓 固定 在 室内 高 处 ， 巧 挂 侦 架 
右 侧 的 两 层 隅 板 用 来 放置 知 干 储 物 单元 ， 本 发 明 设 计 为 2 排 3 列 共 6 个 储 物 单 元 ， 在 储 物 单 
元 中 可 存放 所 述 系统 目 动 分 类 的 各 种 物品 。 

附 图 L-2 为 室内 高 处 空间 物品 存放 及 管理 系统 的 竖 直 升降 装置 工作 平台 示意 图 ， 上 述 竖 
直 升 降 装置 包括 平板 、 电 动机 工 、 同 步 带 轮 1 、 同 步 带 轮 I、 同 步 带 I、 传动 轴 、 卷 线 简 I、 
回 定 轴承 、 齿 轮 、 定 滑轮 1 、 锁 死机 构 、 钢 丝 强 了 、 托 盘 、 滑 块 [和 直线 导轨 1 。 悬 挂 货 架 
左上 方 用 螺丝 固定 平板 ， 在 其 上 方 固 定 电 动机 工 ， 同 步 带 轮 [ 、 同 步 带 轮 工 分 别 与 同步 带 I 
相 吗 合 构成 同步 带 机 构 ， 同 步 带 轮 开 通过 键 配 合 安装 在 传动 轴 上 ， 传 动 轴 则 通过 固定 轴承 安 
装 在 平板 上 ， 其 上 还 安装 有 卷 线 简 工 和 齿轮 ， 钢 丝 绳 工 的 一 端 固定 在 传动 轴 的 卷 线 简 工 上 ， 
另 一 端 通过 定 滑 轮 工 固 定 在 用 于 容纳 储 物 单元 的 托盘 上 ， 电 动机 工 转动 通过 同步 带 机 构 降 速 
传 到 传动 加 上 ， 使 卷 线 简 工 转动 ， 进 而 带动 托盘 升降 ， 与 用 户 进行 储 物 单 元 的 交换 ; 托盘 背 
部 安 闭 两 个 滑 块 工 ， 可 治 焊 接 在 悬挂 货 避 后 方 的 两 根 和 直线 导轨 工 滑 动 ， 以 此 保证 储 物 单 元 在 
竖 特 运动 中 的 平稳 性 ;平板 上 锁 死 机 构 的 衔 铁 ， 在 系统 断 电 后 将 胶 离 电磁 铁 的 吸附 ， 卡 住 传 
动 轴 上 的 齿轮 ， 使 传动 轴 终 止 转动 ， 防 止 托 盘 在 储 物 单 元 及 目 喘 的 重力 下 突然 消 下 伤 及 用 户 。 

附 图 L-3 为 室内 高 处 空间 物品 存放 及 管理 系统 的 水 平 拖 动 装置 示 和 意图， 上述 水 平 拖 动 闭 
置 包括 平板 、 电 动机 开 、 卷 线 简 开 、 定 滑轮 开 、 钢 丝 绳 I 工 、 滑 块 工 和 直线 导轨 开 。 电 动机 开 
固定 在 平板 上 ， 其 转轴 与 卷 线 简 开 连 接 ， 卷 线 简 开 可 收 放 钢丝 绳 工 ， 钢 丝 绳 工 依靠 者 干 定 滑 
轮 开 为 导 癌 布置 在 悬挂 货架 上 ， 电 动机 工 转动 带 动 卷 线 简 开 转动 ， 从 而 市 动 储 物 单 元 取 放 闭 
置 连接 板 [和 连接 板 II 上 的 请 块 工 沿 巧 挂 货 架 前 面 上 下 安装 的 两 条 直线 导轨 开 作 水 平 运动 ， 
横 问 移动 到 软件 管理 平台 指定 的 储 物 单 元 所 在 的 列 上 。 

附 图 L-4 和 附 图 L-5 分 别 为 室内 高 处 空间 物品 存放 及 管理 系统 的 储 物 单 元 取 放 闭 置 示意 
赂 和 主 视 狗 ， 上 述 储 物 单元 取 放 泛 置 包括 电动 机 II、 电 动机 IV、 同 步 市 轮 IIJ、 同 步 市 轮 IV、 
同步 带 开 、 同 步 带 轮 V、 同 步 带 贡 、 托 板 、 丝 枉 、 光 杠 IT、 光 杠 工 、 滑 块 荆 、 连 接 板 I、 连 
接 板 开 、 连 接 板 II 和 连接 板 IV 。 连 接 板 工 与 连接 板 工 用 四 根 光 杠 开 连接 ， 连 接 板 工 和 连接 板 
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IT 用 三 根 穿 过 托 板 的 光村 T 连接 ， 与 光村 I 嵌 套 的 三 个 直线 轴承 安装 在 托 板 上， 连接 板 了 安 
装 清 块 工 两 个 ， 连 接 板 II 安装 清 块 工 一 个 ， 丝 杠 窗 过 托 板 ， 一 端 固 连 在 连接 板 II 上 的 轴承 内 ， 
另 一 端 通过 同步 带 轮 II、 同 步 带 轮 IV、 同 步 带 开 构 成 的 同步 带 机 构 与 电动 机 II 连接 ， 电 动机 
II[ 转 动 带动 丝 杠 旋转 ， 托 板 依靠 直线 轴承 沿 光 杠 工 做 竖 直 升 降 运 动 ， 托 板 下 部 贴 在 同步 带 IT 
与 安装 在 电动 机 转轴 上 的 同步 带 轮 V 哨 合 ， 电 动机 转动 同步 带 轮 V， 进 而 使 托 板 做 抽 拉 
动作 ， 可 实现 在 悬挂 货架 上 或 是 从 托盘 上 取 放 储 物 单元 的 功能 。 

附 图 L-6 为 室内 高 处 空间 物品 存放 及 管理 系统 软件 管理 平台 的 硬件 组 成 示意 图 ， 上 述 软件 管 
理 平台 硬件 设施 包括 触摸 屏 、 扫 码 检 和 条 形 码 打印 机 。 该 硬件 设施 安装 在 悬挂 货架 下 方 用 户 方便 
使 用 处 ， 用 户 在 触摸 屏 上 输入 用 户 名 与 密码 登录 该 管理 平台 后 ， 当 选择 存放 物品 命令 时 ， 用 扫 码 
枪 对 物品 扫 码 ， 系 统 分 析 数 据 锁定 存放 同类 物品 的 储 物 单元 ， 储 物 单元 取 放 装置 接收 到 指令 后 通 
过 水 平 拖 动 装置 及 自身 升降 平台 与 托 板 取 下 该 储 物 单元 ， 传 递 给 竖 直 升降 装置 中 的 托盘 ， 托 盘 在 
钢丝 强 工 带动 下 下 降 ， 交 到 用 户 手 中 ， 用 户 放 入 物品 后 ， 系 统 将 逆向 执行 上 述 过 程 即 自动 放 回 储 
物 单元 ， 若 物品 无 条 形 码 ， 则 用 户 可 自行 录入 ， 将 打印 机 打印 出 的 条 形 码 贴 在 物品 上 ， 再 执行 存 
放 指令 ， 当 进行 取 用 物品 时 ， 用 户 通过 触摸 屏 搜索 该 物品 ， 系 统 同 样 执行 上 述 过 程 自动 取 下 物品 
所 在 储 物 单元 ， 用 户 取出 物品 后 系统 将 储 物 单元 自动 放 回 。 用 户 平常 可 通过 上 述 软件 管理 平台 了 
解 物品 的 存放 日 期 、 存 放 位 置 、 保 质 期 等 详细 信息 ， 以 此 提高 对 所 存 物品 的 管理 能 力 和 取 放 效率 。 

说 明 书 附 图 










































































附 图 L-1 本 发 明 宇内 高 处 空间 物品 存放 及 管理 系统 的 总 体 分 布 图 
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附 图 L-4 本 发 明 室内 高 处 空间 物品 存放 及 管理 系统 的 储 物 单元 取 放 装置 示意 
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附 图 L-5 本 发 明 室 内 高 处 空间 物品 存放 及 管理 系统 的 储 物 单 元 取 放 装置 主 视图 
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附 图 L-6 本 发 明 室 内 高 处 空间 物品 存放 及 管理 系统 软件 管理 平台 的 便 件 组 成 示意 图 
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发 明 人 : 辆 宝 玲 ; 罗 庆生 ; 刘 成 ; 王 帅 ; 范 几 


履 市 吸盘 式 壁 面 清洁 机 器 人 


技术 领域 
本 发 明 属 于 特种 机 各 人 应 用 领域 ， 具 体 涉及 一 种 履带 吸盘 式 壁 面 清 洁 机 絮 人 。 
背景 技术 











目前 有 很 多 关于 壁面 清洗 机 器 人 的 研究 和 已 经 发 表 的 论文 ， 国 内 外 使 用 的 较 多 的 是 是 统 
式 的 高 空 玻璃 清洁 机 器 人 。 昌 然 在 清 涪 局 空 玻璃 方面 这 种 机 器 人 可 以 代替 人 工 ， 减 少 伤亡 事 
故 的 发 生 率 ， 效 率 也 有 一 定 的 提高 ， 但 是 这 关 清 涪 机 器 人 无 法 摆 脐 吊 缆 的 控制 ， 不 具有 智能 
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识别 和 清洗 的 功能 ， 而 且 造价 昂贵 。 对 于 足 式 忠 壁 机 器 人 的 低 使 用 效率 及 所 能 承载 的 整体 重 
量 也 是 很 难 克 服 的 一 大 难关 ， 这 对 于 足 式 的 机 械 机 构 强度 要 求 较 高 。 

北京 航空 航天 大 学 与 金 讯 公司 合作 ， 自 1996 年 来 开发 研究 ， 得 到 目前 来 说 整体 水 平 
与 国外 具有 同步 领先 地 位 的 “蓝天 洁 士 ”玻璃 清洗 机 器 人 。“ 蓝 天 洁 士 ”的 三 个 开发 系列 
主要 针对 于 中 低层 、 中 高 层 、 高 层 、 超 高 层 、 斜 面 、 小 角度 爸 斜 铅 重 平 面 、 小 角度 转折 平 
而 等 不 同 的 清洁 环境 。“ 蓝 天 洁 士 ”的 成 功 标志 着 我 国清 洁 机 器 人 的 水 平 已 经 开始 进入 新 
纪元 。 

前 开发 出 的 “蓝天 洁 士 ”系列 的 玻璃 清 清洗 机 器 人 ， 由 于 此 机 器 人 采用 帅 缆 式 ， 虽然 
可 以 在 很 多 环境 下 进行 作业 ， 但 是 功 耗 量 是 不 可 忽视 的 ， 但 是 吊 缆 式 的 机 器 人 需要 工作 人 员 
不 间 电 的 操作 ， 另 外 ， 还 需要 在 建筑 物 顶 铺设 机 器 人 在 清洁 过 程 中 行进 时 需要 的 轨道 。 我 们 
看 到 了 “蓝天 ”系列 跨 时 代 的 创新 优点 ， 但 也 不 可 忽略 这 些 不 足 。 

为 使 清洗 机 器 人 能 够 具有 更 好 的 适应 能 力 和 清洁 能 力 ， 我 们 致力 于 设计 和 开发 一 种 履带 
吸盘 式 的 壁面 自动 清洗 机 器 人 。 此 机 器 人 可 以 摆脱 吊 费 的 束缚 ， 即 采用 无 线 式 控制 ， 而 且 具 
有 一 定 的 越 障 和 自动 识别 功能 ， 能 在 低 功 耗 的 情况 下 ， 达 到 我 们 需要 的 工作 量 。 壁 面 自动 清 
洗 机 器 人 适用 于 玻璃 幕墙 及 瓷砖 等 壁面 ， 靠 真空 吸盘 的 吸附 能 力 及 履带 的 行进 能 力 可 以 快速 
地 作业 。 不 仅 避免 了 使 用 传统 人 工 清洗 时 清洗 效率 低 、 资 源 浪费 和 事故 频 发 等 现象 ， 也 避免 
了 员 费 式 机 器 人 无 法 摆脱 人 工 操作 、 需 要 预 设 轨道 等 不 足 之 处 ， 而 且 具 有 体积 小 、 适 合 多 种 
材料 壁面 、 低 功 耗 、 效 率 高 等 特色 。 

发 明 内 容 

本 发 明 的 内 容 在 于 设计 和 实现 履带 吸盘 式 壁面 清洁 机 器 人 。 该 机 器 人 靠 装 有 吸盘 的 履带 
行进 ， 履 带 吸盘 与 真空 泰 连接 ， 抽 气 形成 真空 度 ， 吸盘 设计 有 杠杆 销 杀 ， 能 够 通过 杠杆 作用 
放 气 ; 底 稚 中 央 设计 有 转向 吸盘 ,通过 电动 机 控制 丝 杠 的 运转 ,能够 使 车 身 围绕 转向 吸盘 轴 
线 旋转 ， 车 身 前 设计 有 超声 探测 与 反馈 装置 ， 保 证 车 体 在 行进 中 能 在 恰当 时 刻 自动 转向 ， 车 
体 上 装 有 清洁 装置 ， 由 单一 电动 机 控制 驱动 ， 伴 随 车 体 行进 时 进行 清洗 工作 。 通 过 机 械 结构 
设计 、 电 路 控制 与 自动 控制 等 多 方面 结合 ， 使 该 机 器 人 能 在 合适 的 环境 下 忠 壁 并 清洁 壁面 
同时 超声 探测 与 反馈 系统 与 其 他 控制 单位 协调 一 体 保证 了 机 器 人 的 转向 和 越 障 功能 的 完美 
执行 。 

为 了 实现 上 述 发 明 目 的 ， 履 带 吸盘 式 壁 面 清洁 机 器 人 主要 有 以 下 零 部 件 ， 履带、 履带 吸 
盘 、 履 带 驱 动 轮 、 履 带 转动 轮 、 履 带 同步 轮 、 传 动 齿轮 、 驱 动 电动 机 、 底 盘 、 中 央 吸 盘 、 转 
癌 丝 杠 结构 、 转 向 驱动 电动 机 、 真 空 汞 、 导 气管 、 真 空 泵 控制 电动 机 、 电 控 结 构 、 超 声 探 测 
与 反馈 系统 、 排 气 杠杆 、 清 洁 滚 刷 、 清 洁 刮 板 、 喷 水 装置 、 电 池 组 等 。 

主要 设计 包括 以 下 结构 ，@ 履 带 吸盘 结构 :将 吸盘 装配 在 履带 上 ， 根 据 吸盘 吸附 壁面 
的 条 件 ， 设 计 同步 轮 和 杠杆 排 气 机 构 ， 保 证 了 吸盘 与 履带 的 同步 运行 ， 同 时 确定 整 车 的 运 
行路 线 和 状态 。 回 转向 结构 :履带 上 的 吸盘 在 壁面 上 紧 紧 吸 附 ， 无 法 使 整 车 利用 差 速 原理 
转向 ， 安 装 在 底盘 的 中 央 吸 盘 配合 与 底盘 固定 的 转向 丝 杠 的 运动 ， 车 体 可 以 升降 ， 完 成 转 
向， 促进 被 动 吸附 。 轩 履带 吸盘 的 抽 气 与 放 气 结构 :履带 吸盘 的 抽 气 装置 采用 此 轮 配 合 和 
中 轮机 构 ， 通 过 电动 机 驱动 齿轮 带动 凸轮 机 构 运动 ,由 于 齿轮 配合 具有 一 定 的 传动 比 关系 ， 
安装 在 凸轮 上 的 气 路 可 以 反复 与 吸盘 气 路 结合 并 进行 吸 气 ， 吸 盘 设 计 有 杠杆 排 气 装置 ， 当 
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吸盘 随 履 珊 运 动 到 后 轮 时 ， 杠 杆 稣 置 运 行 ， 吸 盘 排 气 。 外 超声 探测 与 反馈 系统 : 该 系统 设 
定 的 探测 障碍 距离 为 车 体 对 角 线 的 一 半 ， 保 证 车 体 在 转向 时 不 会 与 障碍 触 磁 ， 阻 但 转 问 系 
统 的 正音 运行 。 

本 发 明 的 优点 在 于 : 

1) 设计 的 转 回 机 构 元 服 了 此 类 机 器 人 在 壁面 上 难以 转 问 的 难题 ,， 结构 简单， 运行 效率 高 ， 
气 浆 式 吸盘 吸附 效率 高 ， 多 吸盘 可 靠 性 强 。 

2) 履 市 吸盘 的 吸 气 与 排 气 结构 动力 来 目 于 主 红 动 电动 机 ， 提 高 了 能 源 使 用 效率 ， 同 时 利 
用 其 轮 传动 比 与 凸轮 机 构 的 配合 、 杠 杆 排 气 窑 置 ， 保 证 了 吸 气 与 排 气 的 成 功 进行 。 

3) 采用 履 市 吸盘 式 平 台 ， 相 对 于 现 有 的 足 式 能 承受 更 大 的 负载 ， 在 传统 爬 壁 机 郝 人 基础 
上 ， 实 现 了 履 市 吸盘 式 壁 面 机 器 人 的 成 功 研发 ， 显 著 提 高 了 运行 效率 。 

4) 搭建 的 壁面 吸附 平台 具有 较 蜗 的 承载 功能 ， 可 以 广泛 用 于 各 种 光滑 壁面 。 履 市 吸盘 式 
平台 可 以 推广 使 用 的 范围 涉及 车 事 、 国 民生 活 、 工 业 生 产 等 多 方面 。 

附 图 说 明 

附 图 M-1 为 履 市 吸盘 式 壁 面 清洁 机 器 人 整体 示意 网 。 

附 图 M-2 为 履 市 吸盘 式 壁 面 清洁 机 器 人 人 视图 。 

附 图 M-3 为 履 市 吸盘 式 壁 面 清洁 机 器 人 正视 图 。 

附 图 M-4 为 履 市 吸盘 式 壁 面 清洁 机 器 人 装配 图 。 

附 图 M-5 为 履 市 吸盘 式 壁 面 清洁 机 器 人 履 市 示意 

附 图 M-6 为 履 融 吸盘 式 壁 面 清 洁 机 器 人 转 癌 机 构 装配 图 。 

附 图 M-7 为 履 融 吸盘 式 壁 面 清 洁 机 器 人 转 癌 机 构 示 意图 。 

以 上 附 图 中 : 1 一 转 问 机 构 ; 2 一 底盘 ; 3 一 同步 市 ;4 一 主 驱 动 电动 机 ; 5 一 杠杆 触发 疙 置 ; 
6 一 转 回 舱 机 ; 7 一 承 托 染 ; 8 一 真空 倘 ; 9 一 真空 泉 驱 动 电动 机 ;10 一 三 角 染 ;12 一 深 刷 广 染 ; 
13 一 驱动 轴 ; 14 一 文 撑 架 ，15 一 轴承 ;16 一 升降 被 动 齿轮 ;17 一 转 问 被 动 齿 轮 ，18 一 升降 主 
动 齿轮 19 一 丝 枉 ;20 一 转向 主动 齿轮 ，21 一 中 央 吸 嫩 ，22 一 卡 千 ，23 一 吸盘 ，24 一 同步 带 
轮 ; 25 一 同步 市 ;26 一 张 动 轮 ;，27 一 丝 杠 回 定 螺 母 ，28 一 丝 杠 螺母 ，29 一 热 帮 ;30 一 平头 螺 
钉 ; 31 一 放 气 杠杆 ，32 一 固定 销 ;，33 一 橡胶 黎 封 球 ，34 一 压 球 弹 和 仁 ，35 一 放 气 弹 莹 36 一 长 
螺钉 ; 37 一 密封 热 蜀 ; 38 一 螺钉 ; 39 一 转 问 吸盘 柱 ，40 一 放 气 门 ;，41 一 固定 螺钉，42 一 刮 板 ; 
43 一 压 紧 拉 敬 44 一 洲 刷 ; 4 一 三 角 带 ; 46 一 继 动 齿轮 副 ，47 一 配 气 齿 轮 组 ，48 一 凸轮 机 构 。 

具体 实施 方式 


1. 履带 的 结构 与 组 装 

如 附 图 M-5 所 示 ， 履 带 由 同步 带 23、 同 步 珊 轮 24、 驱 动 轮 26、 吸 检 23 组 成 。 为 保证 传 
动 比 ， 通 过 计算 每 个 吸盘 之 间 的 距离 的 理论 值 ， 在 同步 之 上 面 打 孔 ， 将 吸盘 与 同步 带 通 过 压 
带 弹 得 实现 连接 。 

2. 转向 机 构 的 结构 与 组 装 

如 附 图 M-6 和 附 图 M-7 所 示 。 转 问 机 构 主要 由 17、20 构成 的 转 问 齿轮 、16、18 构成 的 
升降 齿轮 、 丝 杠 19、 中 央 吸 各 21、 轴 承 15、 卡 簧 22 等 组 成 。 中 央 吸 盘 与 丝 杠 处 在 同 轴 线 的 
位 置 ， 二 者 固 联 ， 吸 盘 正 上 方 ， 转 向 大 具 轮 17 连接 于 丝 枉 ， 转 向 大 齿轮 上 方 安装 的 是 升降 被 


© 







































































大 学 生 课 外 科技 创新 竞赛 获奖 作品 精 析 


动 齿轮 16， 该 齿轮 与 竣 珠 丝 杠 螺母 28 通过 螺钉 回 连 ， 丝 杠 螺母 与 滩 珠 丝 杠 的 丝 杆 19 的 通过 
深 珠 减 小 摩擦 。 升 降 大 齿轮 与 转向 大 齿轮 17 都 固 连 于 机 吴 确 盘 。 另 外 两 个 20、18 构成 的 传 
动 齿轮 分 唱 与 对 应 的 被 动 疮 轮 形成 晓 合 ， 并 与 园 癌 映 轮 蜗杆 电动 机 的 驱动 端 连 接 。 在 丝 杠 上 
闹 安 北 籼 承 15 及 固定 轴承 用 的 卡 曲 22。 

3. 清洁 系统 组 半 

清洁 系统 包括 筋 状 吧 淋 装 曾 、 深 简 刷 洗 北 置 和 刊 板 刊 洗 准 置 。 清 党 机 构 主 要 由 以 下 部 分 
组 成 : 深 刷 御 、 刊 板 、 机 洒 等 。 将 深 刷 44 及 车 尾 的 乔 板 安 站 于 撒 熏 。 请 党 液 由 水 条 喷 出 冲洗 
并 浸 油 壁面: 随后 由 深 刷 44 刷洗 壁面 ， 除 去 附 独 力 较 大 的 污 拆 ; 最 后 ， 由 天 水 板 刮 净 残 留 的 
液体 。 采 用 冲洗 、 刷 洗 、 刊 洗 联 合作 业 的 清洗 方式 ， 在 浓 洗 的 同时 ， 电 动机 带动 履带 转动 实 
现行 进 过 程 的 顺利 连续 。 并 且 清 洁 装 置 前 置 ， 有 利于 和 死角 的 清洁 ， 清 洗 效 率 高 。 滚 刷 安装 在 
车 体 的 前 方 ， 而 刊 板 安 状 在 车 尾 ， 同 时 对 履 市 行进 之 后 造成 的 并 迹 和 残留 的 污 活 进 一 步 消 理 ， 
尽量 减少 由 于 履带 行进 对 笑 墙 造成 的 污染 ， 使 医 增 更 清洗。 

4. 机 器 人 整体 组 次 

如 附 图 M-4 所 示 ， 在 已 经 加 工 好 的 底盘 2 前 后 10、14- 底 盘 架 上 分 别 安装 好 驱动 轮 、 
前 轮 、 履 带 及 同步 轮 , 在 履带 吸盘 杠杆 劳 将 5$- 杠 杆 触发 装置 安装 于 车 架 上 , 安装 真 空 条 (8)。 
在 底盘 2 的 中 央 扩 孔 处 安 状 转向 机 构 1， 将 承 托 染 7 安装 于 转向 机 构 上 方 ， 转 向 机 构 的 轴 
承 15 安装 于 承 托 染 的 轴承 人 套 中 ， 将 转向 舵 机 6 安装 于 承 托 架 上 。 安 装 驱动 轴 13 于 驱动 轮 
之 间 , 同时 在 击 轮 之 间 也 安 疫 同一 驱动 烛 。 将 同步 市 3 撤 照 前 面 的 步骤 安 闭 在 底盘 另 一 边 ， 
前 后 轮 分 别 靠 驱动 轴 13 连接 在 一 起 。 将 主 驱 动 电动 机 4 安装 于 撒 盘 中 后 部 ， 且 该 电动 机 
传动 轴 上 的 齿轮 与 驱动 轴 13 上 的 齿轮 吐 合 。 在 车 体 上 安装 超声 探测 与 反馈 装 章 及 电路 控 
制 结构 。 

说 明 书 附 图 




























































































附 图 M-1 履带 吸盘 式 壁 面 清洁 机 器 人 整体 示意 图 
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附 图 M-2 履带 吸盘 式 壁 面 清洁 机 融 人 俯视 图 
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附 图 M-4 履带 吸盘 式 壁 和 清洁 机 带 人 装配 图 
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附 图 M-5 履带 吸盘 式 壁 咎 清洁 机 如 人 履 市 示意 图 
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附 图 M-6 履 市 吸盘 式 壁 面 清洁 机 费 人 转向 机 构 装 配 图 
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附录 N 一 种 可 用 于 拒 绕 机 器 人 的 履 审 吸盘 组 合式 行走 六 置 设 计 专 利 


专利 和 名称， 种 可 用 于 疏 辟 机 器 人 的 履带 吸盘 组 合式 行走 装置 设计 
发 明 人 : 拜 宝 玲 ， 罗 庆生 ; 王 帅 ; 范 刚 ;， 刘 成 


一 种 可 用 于 把 壁 机 器 人 的 履 市 吸盘 组 合式 行走 痰 置 设 计 


技术 领域 

本 发 明 属于 技术 及 设备 领域 ， 具 体 涉及 一 种 可 用 于 的 壁 机 器 人 的 履带 吸盘 组 合式 行走 装 
置 设计 。 

背景 技术 

假 壁 机 器 人 因 其 在 垂直 陡 壁 或 高 空 极限 空间 作业 的 特点 ， 已 被 广泛 地 研究 并 应 用 于 清洗 、 
检测 、 侦 察 等 多 个 行业 。 其 按 移动 方式 主要 可 分 为 车 轮 式 、 履 带 式 、 框 架 式 、 足 脚 式 及 轨道 
行进 式 等 ， 吸 附 方式 上 也 有 真空 式 、 磁 吸附 、 静 电 式 等 。 

框架 式 及 足 式 步行 机 器 人 由 于 其 稳定 性 、 宛 余 性 及 控制 复杂 性 等 结构 复杂 性 能 有 待 优化 ， 
磁 吸 附 、 静 电 式 其 适用 范围 较 小 ， 而 履带 真空 吸盘 式 适用 于 一 切 光滑 平整 壁面 ， 吸 附 能 力 强 ， 
行走 平稳 是 壁面 机 器 人 的 发 展 趋势 。 

真空 吸附 吸盘 是 通过 在 真空 发 生 装置 ， 使 吸盘 内 产生 一 定 的 负 压 ， 从 而 形成 在 内 外 气压 
差 形成 的 吸附 力作 用 下 使 机 器 人 本 体 吸附 在 壁面 上 。 市 场 上 现 有 的 硅胶 吸盘 在 吸附 能 力 、 真 
室 度 的 保证 等 方面 已 经 具有 一 定 的 成 果 ， 但 是 用 于 疏 壁 机 器 人 时 由 于 结构 显得 过 于 简单 和 密 
封 性 难以 得 到 保证 ， 而 无 法 满足 履带 式 让 壁 机 器 人 在 壁面 上 行进 时 所 需要 的 条 件 。 

发 明 内 容 

本 吸盘 设计 的 内 容 在 于 提供 一 种 可 以 实现 针对 玻璃 、 盗 砖 等 光洁 壁面 垂直 或 吸 帅 吸 附 并 
行进 的 运动 装置 设计 。 该 设计 采用 了 履带 与 吸盘 组 相 结合 的 结构 ， 主 要 由 以 下 儿 个 零 部 件 组 
成 : 同步 带 、 同 步 带 轮 、 压 带 弹簧 、 吸 盘 柱 体 、 吸 盘 、 压 球 弹 答 、 胶 密封 球 、 放 气 杠杆 等 。 
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本 发 明 为 一 种 多 吸盘 履 市 式 行 走 吸 附 猜 置 ， 提 供 一 种 在 光 请 表面 行走 的 解决 方案 。 该 设 
计 采 用 了 同步 带 与 气 赋 式 吸 盘 相 配合 的 结构 ， 通 过 同步 带 与 同步 轮 之 则 的 蝴 合 ， 以 达到 使 一 
般 机 器 在 光滑 表面 行走 的 功能 。 吸 附 实现 装置 上 采用 气 内 式 吸盘 ， 吸 附 可 为 主动 吸附 或 被 动 
吸附 。 载 何不 是 太 大 时 ， 可 以 采用 被 动 吸附 ， 可 以 用 一 个 装置 在 吸盘 刚 接 触 到 壁面 时 压 住 吸 
盘 顶部 ， 由 于 吸盘 外 置 弹 营 的 存在 ， 会 有 一 个 使 吸盘 问 壁 面 压 么 的 过 程 ， 气 体 挤 开 橡 胶 球 排 
出 ， 吸 熏 内 部 真空 度 达 到 一 定 程 度 时 ， 吸 盘 内 外 压 差 已 经 显著 提高 ， 橡 胶 球 被 大 气压 压 紧 于 
吸 和 可口 ， 从 而 保证 吸 禹 不 会 反问 漏 气 ; 载 答 比较 大 时 ， 可 以 采用 主动 吸附 ， 真 空 泵 通过 导管 
与 吸 生 相连， 初始 吸 气 过 程 中 ， 由 于 橡胶 球 内 外 压 差 关系 气门 被 开启 ， 当 吸 气 过 程 进 行 一 段 
时 间 ， 吸 盘 内 部 真 宇 度 相 比 于 被动 吸附 显 车 提高， 吸附 效果 及 负载 增加 。 当 吸盘 需要 脱离 辟 
面 时 ， 只 要 通过 固定 于 车 架 的 凸 起 钱 置 触发 吸盘 的 杠杆 结构 ， 气 门 打开 吸盘 即 可 了 瞬间 排 气 ， 
使 吸盘 脱离 壁面 。 吸 附 系统 可 以 保证 机 器 人 紧 贴 壁 面 而 不 会 出 现 打 滑 和 脱落 的 现象 ， 同 时 行 
进 机 构 让 机 器 人 可 以 平稳 地 在 壁面 上 移动 。 

扑 壁 机 器 人 的 履 帝 式 吸盘 的 设计 融合 了 真 容 吸 盘 吸 附 方式 和 履 帝 式 行走 方式 的 优点 ， 在 
行进 速度 和 工作 效率 方面 具有 显而易见 的 优势 ， 而 且 履 带 吸 盘 陈 行进 方法 使 机 器 人 能 适应 更 
多 的 工作 环境 ， 在 工作 适应 性 、 越 障 能 力 方面 具有 突出 的 优点 。 

本 友 明 的 优点 如 下 : 

1) 内 置 橡胶 球 通过 吸盘 内 外 显 彰 的 压 差 ， 紧 压 于 吸盘 口 ， 明 显 防止 吸盘 反问 漏 气 。 

2) 吸盘 外 置 的 杠杆 结构 ， 使 放 气 更 加 方便 ， 提 高 了 吸盘 吸 气 和 放 气 的 效率 ， 同 时 反映 在 
履 市 的 行进 速度 的 提高 。 

3) 开发 的 履 融 式 吸 盘 绪 构 设 计价 单 ， 适 用 范围 广 。 

附 图 说 明 

附 图 N-1 为 息 壁 机 器 人 的 履 融 式 吸盘 整体 设计 示意图 。 

附 图 N-2 为 息 壁 机 器 人 的 履 融 式 吸盘 整体 设计 主 视 图 。 

附 图 N-3 为 息 壁 机 器 人 的 履 融 式 吸盘 设计 吸盘 示意图 。 

附 图 N-4 为 息 壁 机 器 人 的 履 融 式 吸盘 设计 吸盘 主 视图 。 

附 图 N-5 为 息 壁 机 器 人 的 履 融 式 吸盘 设计 吸盘 装配 图 。 

附 图 N-6 为 爬 壁 机 器 人 的 履 融 式 吸 盘 设 计 吸 盘 诛 理 剖 视图 。 

以 上 附 图 中 : 1 一 同步 带 ;，2 一 同步 带 轮 ; 3 一 压 禹 弹 赞 ， 4 一 吸 稚 柱 体 ，5 一 吸 禹 ，6 一 抽 
气 接触 上 人 碗 ，7 一 压 球 弹 移 ; 8 一 橡胶 密封 球 ;，9 一 放 气 杠杆 ，10 一 固定 螺栓 ;，11 一 文 撑 垫 厂 ; 
12 一 固定 销 钉 ;13 一 放 和 气门; 14 一 放 气 弹 蓝 15 一 密封 垫圈 16 一 密封 螺钉 ;17 一 螺钉 。 

具体 买 施 方式 

如 附 图 N-1、 附 图 N-2 所 示 ， 为 爬 壁 机 器 人 的 履带 式 吸盘 整体 设计 示意 网， 包括 同步 市 
和 吸盘 ， 吸 盘 结 构 通 过 压 带 弹 竹 3 实现 吸盘 与 同步 带 1 加 工 孔 间 的 柔性 配合 以 保证 其 功能 的 
实现 ， 整 个 朔 置 可 以 由 电动 机 及 减速 机 构 张 动 同 步 带 轮 2 实现 壁面 上 的 吸附 行进 。 

如 附 图 N-3、 附 图 N-4 所 示 ， 为 爬 壁 机 器 人 的 履带 式 吸盘 议 计 吸盘 示意 网 。 吸 盘 结构 简 
单 轻巧 ， 可 通过 抽 和 气 接触 诺 硕 与 其 相应 的 配 气 机构 接 口 实现 方便 快捷 可 等 的 配置 。 

如 附 图 N-5 所 示 ， 为 仆 壁 机 右 人 的 履带 式 吸盘 设计 吸盘 北 配 图 ， 把 橡 股 密封 球 8 放 入 疏 
盘 柱 体 4 中 ， 在 橡胶 密封 球 8 上 放 入 压 球 弹 千 7， 把 压 融 弹 敬 3 套 在 吸盘 柱 体 4 上 ， 抒 上 抽 和 气 
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接触 皮 太 6, 用 固定 螺栓 10 把 文 撑 择 片 11 固定 到 吸盘 柱 体 4 上, 用 固定 销 钉 12 把 放 气 杠杆 9 
与 放 气 门 13 和 支撑 热 片 11 连接 到 一 起 ， 密 封 螺钉 16 和 密封 垫圈 15， 螺 钉 17 和 放 和 气 弹 徐 14 
一 起 放 入 吸盘 柱 体 孔 内 ， 并 旋 紧 密封 螺钉 16。 

如 附 图 N-5 所 示 ， 装 配 好 后 吸盘 的 内 部 结构 ， 气 疾 式 吸盘 功能 的 实现 通过 : 橡胶 密封 球 
8 与 吸盘 柱 体 4 加 工 精度 上 保证 气 密 性 ， 通 过 压 球 弹 先 7 实现 预 紧 ， 抽 气 接 触 皮 碗 6 可 与 扩展 
的 配 气 机 构 相 连接 ; 放 气 弹 赞 14 提供 放 气 门 的 预 紧 及 密封 垫 阐 15 以 保证 与 吸盘 柱 体 4 的 气 
密 性 ， 文 撑 垫 片 11 提供 放 气 杠杆 9 的 文 点 ， 实 现 放 气门 13 的 适时 开 闭 。 

吸 气 或 下 压 吸 盘 时 ， 吸 盘 $ 内 气体 挤 开 橡胶 密封 球 8， 使 吸盘 内 形成 负 压 ， 便 可 吸附 住 。 
放 气 时 ， 杠 杆 被 触 碰 拉动 放 气 门 13 便 可 放 气 ， 不 触 碰 时 ， 放 和 气门 13 在 弹 槛 作用 下 复位 密封 。 

说 明 书 附 图 




















附 图 N-1 疏 辟 机 器 人 的 履 弟 式 吸 盘整 体 设计 示 意 疼 














附 图 N-2” 扑 壁 机 器 人 的 履带 式 吸 副 整体 设计 主 视图 
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